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ABSTRACT 


The  problem  addressed  in  this  research  was  to  provide  a  capability  for  sensing 
previously  unknown  rectilinear,  polyhedral-shaped  objects  in  the  operating  environment  of 
the  autonomous  mobile  robot  Yamabico-1 1 .  The  approach  to  the  system  design  was  based 
on  the  application  of  edge  extraction  and  least  squares  line  fitting  algorithms  of  [PET92]  to 
real-time  camera  images  with  subsequent  filtering  based  on  the  environmental  model  of 
[STE92].  The  output  of  this  processing  was  employed  in  the  recognition  of  obstacles  and 
the  determination  of  object  range  and  dimensions.  These  measurements  were  then  used  in 
path  tracking  commands,  supported  by  Yamabico's  Model-based  Mobile  Robot  Language 
(MML),  for  performing  smooth,  safe  obstacle  avoidance  maneuvers.  This  work  resulted  in 
a  system  able  to  localize  objects  in  images  taken  from  the  robot,  provide  location  and  size 
data,  and  cause  proper  path  adjustments.  Accuracies  on  the  order  of  one  to  ten  centimeters 
in  range  and  one-half  to  two  centimeters  in  dimensions  were  achieved. 
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I.  INTRODUCTION 


A.  BACKGROUND 

Object  recognition  is  a  common  application  of  computer  vision  and  in  fact  has  become 
a  common  component  in  many  manufacturing  processes  requiring  recognition  of  specific 
parts  and  the  subsequent  transport  to  various  locations.  In  much  of  the  research  in  this  area, 
either  a  search  is  conducted  for  a  specific  object  within  the  confines  of  the  image  or 
heuristics  are  applied  in  analyzing  the  image  in  an  attempt  to  identify  objects.  A  specific 
branch  of  computer  vision,  robot  vision,  has  been  the  subject  of  significant  research  in  the 
past  decade.  While  many  of  the  basic  approaches  have  undergone  progressive  refinement, 
numerous  new  directions  continue  to  be  pursued  in  both  general  and  system  specific 
applications.  A  vision  system  for  an  autonomous  vehicle  may  be  employed  for  a  variety  of 
uses  including  navigation,  object  recognition,  and  environmental  mapping.  Of  course,  the 
usefulness  of  any  such  system  is  limited  by  the  robotic  platform  into  which  it  is  integrated. 
In  previous  research  at  the  Naval  Postgraduate  School,  robot  position  determination 
through  camera  vision  was  addressed  in  [PET  92]  and  resulted  in  accuracies  varying  from 
a  few  inches  to  more  than  one  foot.  However,  recent  work  using  line  segment  extraction  via 
sonar  [MAC  93]  on  the  Ycanabico-11  robot  has  provided  positioning  accuracies  on  the 
order  of  a  fraction  of  a  centimeter,  virtually  eliminating  the  usefulness  of  implementing  the 
visual  system  as  originally  intended. 

B.  OVERVIEW 

Although  Yamabico  may  have  precise  knowledge  of  its  location  in  a  given 
environment,  it  is  only  capable  of  detecting  the  presence  of  unexpected  obstacles  in  its  path 
when  relying  on  sonar  as  the  sole  sensor.  The  ability  to  determine  position  accurately  does 
allow  a  new  approach  to  be  evaluated  which  incorporates  vision  as  an  additional  sensor 
with  complementary  capabilities  to  that  of  sonar.  Specifically,  if  a  model  of  the 
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environment  and  its  location  within  that  environment  are  known,  it  should  be  possible  to 
immediately  detect  unexpected  elements  in  what  the  robot  camera  sees  by  filtering  out 
those  elements  which  are  in  a  generated  image  based  on  the  model.  This  alleviates  the  need 
for  pre-processing  the  image  before  any  interpretation  may  be  attempted.  This  makes 
isolation  of  an  obstacle  fairly  straight  forward.  Hence,  the  fusion  of  object  recognition 
through  vision  and  the  current  precise  locomotion  capability  can  provide  the  necessary 
foundation  for  intelligent  and  autonomous  obstacle  avoidance.  It  is  on  this  basic  premise 
that  the  vision  system  for  Yanuibico  has  been  designed  and  implemented. 
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II.  PROBLEM  STATEMENT 


The  problem  being  addressed  in  this  work  is  as  follows: 

Given  a  mobile  autonomous  vehicle  with  accurate  knowledge  of  its  position  in  a  partially 
known  environment,  develop  the  capability  to  detect  objects  in  a  video  image  taken  from 
the  robotic  platform  by  recognizing  elements  unknown  to  the  environmental  model,  and 
subsequently  extract  range  and  dimension  data  which  will  aid  in  avoidance  maneuvers. 
This  information  should  be  derived  solely  from  the  information  provided  by  the  vision 
system  without  input  from  other  active  external  sensing  systems. 

A.  ASSUMPTIONS 

The  following  assumptions  were  incorporated  into  the  research  in  order  to  focus  the 
work  on  the  image  understanding  problem  and  ensure  the  goals  were  realizable  with  a 
single  camera  system  (i.e.  no  stereo  vision). 

1.  Orthogonal  World 

The  robot  is  operating  in  a  partially  known,  orthogonal  world.  The  world  is 
partially  known  in  that  the  robot  has  information  on  the  location  of  fixed  walls,  but  has  no 
information  on  the  positions  of  doors  or  the  presence  of  obstacles  in  the  world.  The  world 
is  orthogonal  in  that  all  walls  meet  at  right  angles.  The  normal  operating  environment  for 
Yamabico  is  the  fifth  floor  of  Spanagel  Hall,  which  adequately  meets  the  above 
assumptions. 

2.  Obstacle  Constraints 

An  obstacle  is  any  object  that  is  not  pan  of  the  known  world.  The  placement  of 
obstacles  is  arbitrary,  with  a  restriction  that  they  rest  on  the  floor  and  not  be  suspended  in 
the  air.  This  is  not  unreasonable  since  it  would  be  highly  unlikely  for  a  suspended  obstacle 
to  be  encountered  which  is  not  a  permanent  part  of  the  operating  environment  An 
additional  constraint  on  the  research  is  that  when  an  object  is  encountered,  it  is  assumed 
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that  it  is  positioned  orthogonal  to  the  robot  so  that  base  edges  can  be  used  in  calculating 
ranges  with  a  single  camera.  Obstacles  are  assumed  to  be  stationary  while  the  robot  is  in 
the  vicinity  of  the  obstacle.  However,  if  the  robot  leaves  and  then  returns  to  the  same  area, 
the  obstacle  may  be  in  the  same  position,  a  dijtferent  position,  or  it  may  be  gone. 

3.  Environment  Model  and  Localization 

The  experimentation  assumed  the  existence  of  a  three-dimensional,  wire-frame 
model  of  the  robot’s  operating  environment  as  well  as  accurate  knowledge  of  the  position 
within  this  domain.  These  requirements  are  c^inly  realizable,  and  in  fact  each  has  been 
achieved  in  previous  work  at  the  Naval  Postgraduate  School. 

B.  APPROACH 

Like  many  research  projects,  the  job  of  employing  vision  in  support  of  obstacle 
avoidance  for  an  autonomous  mobile  robot  entails  a  step-wise  progression  toward  the 
desired  capability. 

1.  Object  Extraction 

The  fundamental  problem  is  to  derive  the  ability  to  recognize  the  existence  of  an 
obstacle  in  the  robot’s  path  which  could  prevent  it  from  safely  carrying  out  its  assigned  task 
or  proceeding  to  the  desired  goal.  This  basic  functionality  requires  knowledge  of  what  the 
robot  anticipates  encountering  combined  with  subsequent  recognition  of  elements  in  the 
environment  which  conflict  with  this  a  priori  expectation.  Requirements  inherent  in  this 
task  are  proper  generation  of  the  expected  view  (provided  by  an  environmental  model  in 
the  case  of  this  work),  processing  of  an  input  video  image,  pattern  matching  between  the 
two,  and  a  subsequent  localization  of  an  object  The  localization  process  can  become  more 
difficult  when  multiple  objects  are  considered.  The  problem  at  this  stage  is  to  develop  an 
efficient  algorithm  which  can  properly  group  associated  line  segments  together  to  form 
each  object  Once  this  has  been  accomplished,  the  same  approach  as  was  used  for  the 
single  object  case  can  be  applied  to  obtain  individual  object  dimension  and  location  data. 
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2.  Evaluation 

Once  the  presence  of  an  “object”  has  been  confirmed,  it  is  desirable  to  evaluate 
the  dimensions  and  location  of  the  object  so  that  appropriate  avoidance  measures  may  be 
pursued.  At  this  stage,  the  vision  system  is  capable  of  providing  information  which  will 
allow  initial  path  corrections  to  be  carried  out  but  can  not  provide  insight  into  how  long  the 
object  will  be  of  concern  to  the  robot  This  limitation  exists  because  the  data  obtained  from 
the  image  is  based  solely  on  two-dimensional  information,  and  the  classification  of  the 
object  type  is  not  generally  required  in  order  to  adequately  carry  out  this  fundamental 
assessment  It  should  be  noted  that  this  aspect  of  the  research  is  actually  the  central  concern, 
with  a  primary  goal  of  ensuring  robust  and  consistent  implementation  of  this  capability. 

3.  Obstacle  Avoidance 

One  of  the  most  notable  aspects  of  Yamabico  is  a  fine  and  extensive  locomotion 
capability,  making  obstacle  avoidance  relatively  straight  forward.  Combining  the  range  and 
dimension  data  generated  in  the  evaluation  described  above  with  the  variety  of  path  types 
available  through  the  Model-based  Mobile  Robot  Language  (MML)  used  to  control  the 
robot  enables  the  performance  of  a  smooth,  safe  obstacle  avoidance  maneuver. 
Specifically,  the  use  of  parabolic-curved  elements  would  enable  the  robot  to  accurately 
track  a  path  specified  according  to  Voroinoi  boundaries  between  the  obstacle  and  the 
sunounding  environment,  thus  providing  the  maximum  safe  path  [KAN93].  Since  the 
motion  is  based  on  a  path-tracking  approach,  the  robot  can  automatically  make  smooth 
transitions  between  newly  computed  paths. 

4.  Object  Identification 

Although  not  pursued  in  this  work,  the  ability  to  extract  enough  information  from 
the  image  for  identification  of  the  object  would  provide  three-dimensional  information, 
thus  enhancing  the  “intelligence”  of  the  robot’s  obstacle  avoidance  maneuvers.  This  topic 
is  in  itself  a  widely  researched  field  and  numerous  approaches  have  been  suggested  for  a 
wide  range  of  applications.  One  technique  which  appears  to  be  especially  attractive  for 
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implementation  on  Yamabico  is  the  alignment  method  [ULL91].  The  basic  premise  of  this 
approach  is  that  given  a  known  set  of  feature  points  for  a  known  object  and  the  same  points 
on  an  unknown  object,  it  is  possible  to  map  the  two  sets  via  constant  coefficient  linear 
equations  if  they  are  alike.  The  powerful  aspect  of  this  relationship  is  the  fact  that  it  is  valid 
regardless  of  rotational  and/or  translational  differences,  permitting  direct  analysis  of  image 
objects  according  to  the  object  database.  Once  the  object  has  been  classified,  available 
information  would  include  the  object  depth,  which  provides  the  final  parameter  needed  to 
carry  out  complete  avoidance  measures  solely  on  the  basis  of  visual  input 
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in.  YAMABICO‘ll  ROBOT 


Yamabico'll,  shown  in  Figure  3.1,  is  an  autonomous  mobile  robot  used  as  a  test 
platform  for  research  in  path  planning,  obstacle  avoidance,  environment  exploration,  path 
tracking,  and  image  understanding. 

A.  HARDWARE 

The  robot  is  powered  by  two  12-volt  batteries  and  is  driven  on  two  wheels  by  DC 
motors  which  drive  and  steer  the  robot  while  four  spring-loaded  caster  wheels  provide 
balance. 

The  master  processor  is  a  MC68020  32-bit  microprocessor  accompanied  by  a 
MC6888 1  floating  point  co-processor.  (This  is  the  exact  same  (2PU  as  a  Sun-3 
workstation).  This  processor  has  one  megabyte  of  main  memory  and  runs  with  a  clock 
speed  of  16MHz  on  a  VME  bus.  An  upgrade  to  a  SPARC-4  processor  with  16  megabytes 
of  main  memory  was  nearing  completion  when  this  research  was  completed. 

All  programs  on  the  robot  are  developed  using  a  Sun  3/60  workstation  and  UNIX 
operating  system.  These  programs  are  Hrst  compiled  and  then  downloaded  to  the  robot  via 
a  RS-232  link  at  9600  baud  rate  using  a  PowerBook’’^  145  computer  for  the 
communication  interface.  The  new  SPARC-4  board  will  be  accessible  via  an  ethemet 
connection,  decreasing  download  time  from  about  five  minutes  to  a  few  seconds. 

Twelve  40  kHz  ultrasonic  sensors  are  provided  as  the  primaiy  means  by  which  the 
robot  senses  its  environment  The  sonar  subsystem  is  controlled  by  an  8748  micro¬ 
controller.  Each  sonar  reading  cycle  takes  approximately  24  milliseconds. 

The  visual  images  from  the  robot  are  generated  by  a  WC  TK870U  CCD  camera  head 
equipped  with  a  FUJINON  TV  zoom  lens.  The  unit  is  mounted  along  the  centerline  of  the 
robot  at  a  height  of  34  inches.  This  camera  provides  a  NTSC  standard  RGB  video  image 
through  a  video  framer  attached  to  a  Silicon  Graphics  Personal  Iris'^  workstation  as  shown 
in  Figure  3.2.  The  framer  digitizes  the  sync  and  composite  signals  for  storage  on  the  Iris 
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Figure  3.1:  Yamabico-1 1  Mobile  Robot 
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and  also  passes  the  signal  to  a  high  definition  monitor.  Currently,  the  video  signal  is 
transmitted  via  standard  coaxial  video  cable  to  the  image  processing  hardware.  When 


Composite  &  Sync 
Video  Cables 


Figure  32:  Vision  system  hardware  arrangement 


operating  with  the  vision  system  on  line,  a  telephone  line  is  also  connected  between  the 
processing  hardware  and  the  robot,  via  RS232  ports,  eliminating  the  need  for  the 
PowerBook''^.  This  allows  interactive  simulation  of  visual  interpretation  in  support  of 
obstacle  avoidance  to  be  conducted  in  lieu  of  the  eventual  on-board  image  processing 
capability  which  will  be  integrated  on  the  VME  bus  in  the  future. 
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B.  SOFTWARE 

The  software  system  consists  of  a  kernel  and  a  user  program.  The  kernel  is 
approximately  82,000  bytes  and  only  needs  to  be  downloaded  once  during  the  course  of  a 
given  experiment  The  user’s  program  can  be  modified  and  downloaded  quickly  to  support 
rapid  development 

Motion  and  sonar  commands  are  issued  by  the  user  in  MML,  the  model-based 
mobile  robot  language.  While  the  previous  version  of  MML  was  based  on  point-to-point 
tracking,  the  current  version  being  integrated  into  Yamabico's  control  structure  relies  on  a 
‘path  tracking’  approach.  While  MML  provides  the  capability  to  define  path  types  which 
include  parabolic  and  cubic  spiral,  the  most  fundamental  ‘path’  for  the  robot  to  follow  is  a 
line  which  is  defined  by  a  curvature  (K)  and  a  location  and  orientation  in  two-dimensional 
space  described  in  x,  y,  and  theta.  With  K=0,  the  line  is  straight,  and  1C^  produces  a  circle 
of  radius  1/K  (K<0  =  clockwise  &  K>0  =  counter-clockwise).  The  location  and  orientation 
can  be  the  starting  point  of  a  semi-infinite  line  called  a  forward  line  ifline),  the  end  point  of 
a  semi-infinite  line  called  a  backward  line  (bline),  or  a  point  and  direction  along  and  infinite 
line  (line).  For  all  path  types,  once  one  has  been  specified  and  conunanded,  the  robot 
performs  the  required  calculations  and  adjusts  the  curvature  of  its  motion  as  necessary. 
Additionally,  transitions  between  successive  paths  are  performed  automatically  and 
autonomously. 

The  functionality  inherent  in  the  MML  plays  a  significant  role  in  developing  the 
capability  for  the  robot  to  avoid  obstacles.  Consequently,  a  portion  of  this  research  effort 
was  devoted  to  implementing  some  of  the  core  functions  in  the  newly  developed  ‘path 
tracking’  approach  to  motion  control.  This  method  allows  for  dynamic  real-time 
specification  of  the  proposed  robot  path  based  on  sensory  input  and  is  especially  well  suited 
to  employing  the  information  generated  from  object  recognition.  Since  the  available 
information  wiU  include  not  only  ranges  (which  is  the  sole  data  provided  by  sonar)  but  also 
dimensions,  a  complete  avoidance  maneuver  can  be  determined. 
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As  mentioned  above,  the  sonar  system  is  also  controlled  through  the  MML.  Both 
raw  sonar  range  returns  as  well  as  processed  ‘global’  results  incorporating  least-squares 
line  fitting  are  available  to  the  user  on  board  the  robot  This  capability  should  prove 
particularly  useful  in  extending  the  environment  in  which  the  vision  system  can  be  applied, 
and  its  application  is  addressed  in  the  discussion  of  the  environmental  model. 
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IV.  SYSTEM  COMPONENTS 


A.  THREE-DIMENSIONAL  WIRE-FRAME  MODEL 

One  of  the  key  components  of  the  obstacle  detection  routine  as  implemented  on 
Yamabico  is  the  process  by  which  known  or  expected  edges  are  filtered  from  the  acquired 
video  input  by  matching  the  edges  extracted  from  the  video  image  to  corresponding  edges 
in  a  superimposed  model  image.  In  order  to  accomplish  this  task,  a  wire-frame  model  of  the 
robot’s  operating  environment  created  by  Jim  Stein  in  [STE  92]  was  employed.  The 
following  is  a  general  description  of  the  method  by  which  this  model  is  implemented  along 
with  a  discussion  of  the  modifications  which  were  required  for  integration  into  this  work. 
The  modifred  code  is  provided  in  Appendix  A  and  includes  all  files  with  a  ‘model’  prefix. 

1.  Operating  Environment 

The  fifth  floor  of  Spanagel  Hall  at  the  Naval  Postgraduate  School  is  currendy  the 
only  environment  in  which  testing  of  Ycanabico  is  conducted.  Consequendy,  a  three- 
dimensional  model  of  this  area  has  been  created  using  precise  measurements  (within  a 
quarter  centimeter).  It  is  based  on  a  hierarchical  list  structure  which  consists  of  a  world, 
various  polyhedra  within  the  world  (including  instances  of  similar  configurations),  and 
polygons  (made  up  of  three  or  more  vertices  described  in  terms  of  local  two-dimensional 
coordinate  space)  which  are  connected  to  form  each  polyhedron.  In  defrning  each  polygon, 
a  ‘z’  coordinate  value  is  included  to  specify  its  height  Subsequendy,  corresponding  (x,y) 
vertices  from  polygons  of  differing  heights  may  be  connected  by  edges  to  form  walls  or 
other  vertical  plane  structures.  It  should  be  noted  that  since  the  height  of  the  vertices  of  a 
polygon  is  limited  tr.  a  single  value,  this  structure  is  stricdy  limited  to  being  a  horizontal 
surface. 

As  a  simple  example,  a  rectangular  room  would  be  represented  as  a  world 
containing  one  polyhedron,  namely  the  room,  and  two  polygons,  the  floor  described  by  the 
four  (x,y)  vertices  of  the  comers  with  a  height  of  zero,  and  the  ceiling  described  by  the  same 
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(x,y)  vertices  but  with  a  height  equal  to  that  of  the  actual  ceiling.  Finally,  each  set  of 
corresponding  vertices  are  connected  by  a  pointer  which  represents  a  vertical  line,  in  this 
case  the  comers  from  floor  to  ceiling.  It  should  be  noted  that  under  this  system,  anything 
added  to  the  world  must  be  described  in  three-dimensional  terms  since  a  minimum  of  three 
vertices  are  required  to  create  a  valid  polyhedron.  This  restriction  would  at  first  appear  to 
prohibit  the  inclusion  of  various  items  in  the  real  environment  such  as  room  placards  which 
are  essentially  two-dimensional.  In  fact,  by  describing  such  an  item  with  a  very  small 
thickness  (one  tenth  of  an  inch  perhaps)  this  limitation  is  lifted. 

A  number  of  aspects  to  this  model  directly  impact  the  degree  to  which  the  vision 
system  may  be  employed.  One  is  that  the  distinction  between  status  as  an  obstacle  or  an 
enclosure  is  inherent  to  the  polygon  description  by  the  order  in  which  vertices  are  defined. 
Specification  in  a  clockwise  manner  denotes  an  enclosure  while  a  counter-clockwise  order 
is  used  for  obstacles.  Another  is  the  capability  to  specify  a  pivoting  axis  (in  the  z  direction 
only)  and  the  corresponding  degree  of  rotation  about  that  axis  for  each  polyhedron.  Thus  a 
door  is  not  limited  to  strictly  an  open  or  shut  condition,  and  its  position  may  be  altered 
accordingly.  A  final  important  facet  to  the  model  is  the  ease  with  which  changes  can  be 
made  to  the  modeled  environment.  The  implications  here  are  that  fairly  accurate  object 
recognition  data  can  be  used  to  update  the  model  on  a  real-time  basis,  and  additionally  a 
completely  new  environment  may  be  mapped  via  automated  sonar  cartography  [MAC93] 
with  subsequent  generation  of  a  viable  model  for  use  by  the  vision  system  in  pattern 
matching  routines. 

The  fifth  floor  model  originally  consisted  of  only  the  main  wall  structures,  floor, 
ceiling  (with  lights),  doors,  and  floor  molding  and  did  not  include  various  items  such  as 
door  placards,  bulletin  boards,  etc.,  all  of  which  significantly  impact  the  edges  which  are 
extracted  from  a  video  image.  Consequently,  accurate  measurements  of  all  permanent 
flxtures  which  would  be  picked  up  via  video  were  taken,  and  the  appropriate  structures 
were  created  and  added  to  the  database  for  the  fifth  deck  passageway.  Subsequent  to  these 
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modifications,  the  model  could  be  relied  upon  for  use  in  filtering  out  all  expected  edges 
from  the  input  images. 


2.  Two-Dimensional  Projection 

Although  having  an  accurate  model  of  the  robot’s  operating  environment  is 
fundamental  to  the  foundation  for  object  recognition,  it  would  be  useless  without  any 
means  by  which  to  project  the  three-dimensional  view  onto  the  two-dimensional  image 
plane  for  matching  purposes.  By  applying  fundamental  three-dimensional  mapping 
techniques  and  incorporating  derived  parameters  of  the  video  hardware,  the  two- 
dimensional  perspective  from  any  given  position  (x,y,z,q)  can  be  projected  onto  a  plane 
which  emulates  that  of  the  focal  plane  of  the  video  camera  as  shown  in  Hgure  4.1.  This 


□ 

□ 

Figure  4.1:  Two-dimensional  view  generated  &x>m  the  three-dimensional  wire-frame  model 

image  can  then  be  superimposed  upon  a  video  image  for  visually  assessing  the  match-up, 
and  model  line  segments  can  be  conqiaied  to  image  line  segments  on  a  pixel  basis,  as  is 
carried  out  in  programs  described  in  Chapter  V.  To  aid  in  the  matching  process,  model  lines 
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are  stored  in  two  lists,  one  for  vertical  lines  and  the  other  for  the  rest  Each  nK>del  line  is 
described  by  both  end  points  (given  as  x.y  pixel  coordinates)  and  pixel  length. 

3.  Coordinate  System  Transformations 

Two  coordinate  transformations  are  necessary  if  location  data  for  an  object, 
generated  via  the  vision  system,  is  to  be  useful  in  maneuvering  the  robot  The  first  is 
required  because  the  coordinate  system  on  which  the  wire-frame  model  used  by  the  vision 
system  is  based  differs  in  both  axis  direction  and  origin  point  from  the  system  now  being 
used  in  the  Yamabico  project.  Figure  4.2  shows  the  current  coordinate  system  in  solid  lines 
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Figure  4.2:  Comparison  of  Yamabico  operating  envinmment  coordinate  systems 


while  the  vision  system’s  frame  of  reference  is  given  in  dashed  lines.  From  this  drawing  it 
can  be  seen  that  for  a  given  (xi,  yi,  ©j)  in  the  old  reference  frame,  the  coordinates  in  the 
current  system  would  be  (y|,  w  -  xj,  Gj). 
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Once  the  robot’s  position  is  known  in  the  current  system,  it  is  desirable  to 
transform  vision  generated  object  location  data  into  the  global  reference  frame  since  all 
commands  for  the  locomotion  control  of  the  robot,  as  well  as  all  processed  sonar  data,  are 
given  with  respect  to  this  coordinate  system.  Given  the  robot’s  position  described  by  a 
configuration  which  is  comprised  of  its  x,  y,  and  6  values  referenced  to  the  current  global 
coordinate  system  and  a  local  coordinate  system  fixed  on  the  robot,  a  location  in  the  robot 
local  system  may  be  described  with  respect  to  the  global  system  through  the  use  of  the 
compose  function  [KAN  93].  Referring  to  Figure  4.3,  if  the  position  of  the  robot  in  the 


global  system  is  given  as  Qq  and  the  position  of  an  object  in  the  robot  local  system  as  qj, 
then  the  object’s  position  described  in  the  global  system  will  be  q  and  is  equal  to  the 
composition  of  q^  with  qi,  where  the  compose  function  is  defined  as  follows: 
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Note  that  in  this  situation  the  resulting  orientation  value  (Sq  +  0i)  actually 
contains  no  significant  information  because  even  though  the  robot’s  orientation  (Oq)  is 
usually  a  known  quantity,  the  orientation  of  the  object  (6i)  is  purely  arbitrary. 

B.  EDGE  EXTRACTION 

The  ability  to  extract  edge  information  which  will  be  matched  against  the  two- 
dimensional  projection  generated  by  the  model  provides  the  foundation  for  being  able  to 
analyze  the  video  images  seen  by  the  robot.  While  the  initial  implementation  of  vision  for 
Yamabico  has  become  obsolete,  a  portion  of  the  groundwork  was  applicable  to  this  effort 
Namely,  the  routines  coded  by  Kevin  Peterson  in  IPET92)  which  provide  edge  extraction 
of  (XD  video  camera  input  (stored  as  an  RGB  image)  via  gradient  intensity  analysis  and 
application  of  a  least  squares  method  of  line  determination.  As  in  the  case  of  the  wire-frame 
model,  a  general  description  of  the  implementation  is  provided  and  includes  those  aspects 
which  were  modified  in  order  to  better  support  the  goals  of  this  woric. 

1.  Pixel  Storage  and  Manipulation 

The  data  generated  by  the  video  frame  grabber  is  stored  in  a  32  bit  format  with 
eight  bit  values  for  the  level  of  red,  green,  and  blue  intensity  of  each  pixel  in  the  image, 
giving  a  range  of  0  to  25S.  A  conceptual  block  of  storage  for  describing  a  single  pixel  is 
shown  in  Figure  4.4.  The  alpha  component,  which  represents  the  transparency  of  the  pixel, 
is  not  considered  when  using  the  RGB  format  since  all  pixels  are  taken  to  be  completely 
opaque.  The  data  for  all  the  pixels  in  an  image  is  stored  in  a  long,  one-dimensional  array 
which  is  manipulated  by  pointers.  The  ordering  in  the  array  with  regard  to  position  in  the 
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image  is  left  to  right,  bottom  to  top,  so  the  lower  left  comer  pixel  would  be  the  first  element 
in  the  array  while  the  upper  right  would  be  the  last.  Since  the  edge  extraction  process,  which 
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Figm  4.4: 32  Bit  pixel  storage  format 


will  be  described  below,  requires  a  black  and  white  (‘grayscale’)  representation  for  the 
pixels  in  an  image,  a  conversion  from  the  RGB  values  is  necessary.  According  to  the 
standard  weighting  factors  set  by  the  National  Television  Systems  Committee  (NTSC),  a 
RGB  color  pixel  is  given  an  equivalent  grayscale  value  by  the  following  relationship: 


GRAYSCALE  =  [0.299  0.587  0.114] 


Red  Intensity 
Green  Intensity 
Blue  Intensity 


An  example  of  a  grayscale  image  is  shown  in  Figure  4.5.  It  should  be  noted  that 
since  the  factor  for  green  dominates  over  the  other  two  colors,  it  is  possible  to  reduce  the 
computation  involved  in  this  conversion  to  a  single  intensity  value  by  basing  it  on  only  the 
green  intensity.  This,  in  fact,  is  how  the  process  was  implemented  in  Peterson’s  work.  After 
experimentation  in  the  current  application,  however,  it  was  determined  that  better  image 
analysis  resulted  when  all  three  colors  were  considered.  The  increased  processing  time  is 
negligible  with  respect  to  the  overall  analysis  and  consequently  this  implementation 
employs  the  conversion  shown  above. 

With  each  pixel  now  described  by  a  single  intensity  value,  a  Sobel  operator  is 
applied  in  order  to  determine  the  change  in  horizontal  and  vertical  intensity  with  respect  to 
those  pixels  which  surround  it  Figure  4.6  shows  the  Sobel  matrix  window  where  the  values 
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in  the  boxes  are  the  factors  by  which  grayscale  pixels  intensity  is  multiplied  and  the  boxes 
themselves  represent  a  pixel  with  the  center  box  being  the  pixel  to  which  the  operator  is 


Figure  4.5:  Grayscale  image  of  hallway 
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Figure  4.6:  Sobel  matrix  window  for  pixel  gradient  determination 


being  applied.  A  pixel’s  gradient  magnitude  and  direction  is  then  given  by  the  following 
relations  where  the  atan2  functions  returns  the  arc  tangent  in  the  range  -7C/2  to  Till. 
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Gradient  Magnitude  =*  (dx^  +  dy^)^^ 
Gradient  Direction  »  atan2(  dy .  dx ) 


2.  Edge  Determination 

The  first  two  of  five  criterion  for  line  image  analysis  are  now  available  at  this 
point  In  order  for  a  pixel  to  even  be  considered  for  inclusion  in  an  edge  region,  its  gradient 
magnitude  must  be  above  a  specified  threshold  value  (Cj).  It  is  possible  to  construct  a 
‘gradient’  image  based  on  this  information  alone  as  shown  in  Figure  4.7.  In  this  fonnat. 


Figure  4.7:  Gradient  image  of  nallway 


pixels  with  a  gradient  magnitude  above  C]  are  stored  as  pure  black  while  the  rest  are  stored 
as  pure  white.  Although  this  rq>resentation  is  not  explicitly  used  in  the  subsequent  edge 
generation  and  line  determination,  it  does  provide  insight  into  how  well  the  Sobel  is 
isolating  regions  of  differing  light  intensity. 
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By  grouping  together  adjacent  pixels  (which  have  met  the  Cj  criteria)  with 
gradient  directions  which  differ  by  a  set  angular  amount  (C2),  edge  regions  are  generated 
for  the  entire  image.  As  each  pixel  is  added,  the  primary  moments  of  inertia  (which  include 
the  total  number  of  pixels  in  the  edge)  are  updated  for  the  region.  Additionally,  once  no 
more  pixels  are  to  be  added  to  an  edge,  it  is  inunediately  analyzed  for  line  fitting  potential. 

3.  Least  Squares  Line  Fitting 

Once  all  of  the  appropriate  pixels  have  been  included  to  foim  an  edge,  the  region’s 
secondary  moments  of  inertia  are  computed,  making  it  possible  to  represent  the  area  as  an 
equivalent  ellipse  of  inertia  with  a  major  and  minor  axis  length.  Additionally,  rho  is  defined 
as  the  ratio  between  the  two  axes  and  describes  edge  thickness.  A  line  is  then  fitted  by 
applying  the  final  three  criterion  which  include  maximum  thickness  (C3),  minimum 
number  of  pixels  {C4),  and  minimum  length  (C5).  Of  these,  C3  has  the  most  significant 
overall  impact  as  a  value  of  0.1  requires  a  fairly  thin  region  while  a  value  of  1.0  permits  a 
square  blob  to  be  a  candidate  for  line  fitting.  Figure  4.8  shows  the  lines  which  were  fitted 
based  on  the  image  in  Figure  4.7.  After  extensive  testing,  the  values  used  for  all  the 
criterion,  with  the  exception  of  Cj,  were  modified  in  order  to  provide  the  most  useful  line 
segments  to  the  object  recognition  routines.  The  code,  as  modified  for  this  implementation, 
is  provided  in  Appendix  A. 

C.  VISION  SYSTEM 

1.  Camera  Mounting 

In  mounting  the  CCD  camera  on  Yamabico,  a  number  of  variables  had  to  be  taken 
into  consideration.  Among  the  less  significant  concerns  was  the  desire  not  to  interfere  with 
the  operation  of  other  robot  components  and  to  avoid  placement  which  would  signiftcantly 
alter  the  confines  of  the  robot  structure.  Of  course,  the  primary  criteria  was  finding  a 
location  which  provided  the  most  useful  field  of  view  for  the  task  at  hand.  Due  to  the 
hardware  limitations  of  the  current  camera,  the  zoom  and  focus  must  remain  static  and 
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consequently,  the  depth  of  image  which  is  generated  is  consunt  This  translates  into  the 
restriction  that  the  only  way  to  alter  the  range  at  which  objects  initially  come  into  view  is 


Figuie  4.8:  Line  segments  extracted  from  gradient  image  in  Figure  4.7 


by  physically  altering  the  line  of  sight  direction  of  the  entire  camera.  When  tilted  downward 
in  an  effort  to  pick  up  objects  at  fairly  close  range,  two  significant  problems  were 
introduced.  The  first  resulted  from  the  specular  reflection  of  the  florescent  lighting  system 
in  the  passageway  upon  the  tile  floor  which  resulted  in  a  sharp  increase  in  the  amount  of 
clutter  picked  up  in  the  gradient  image.  Figures  4.9  and  4.10  show  the  grayscale  and 
gradient  images  taken  from  the  same  location  as  those  taken  in  Figures  4.5  and  4.7  but  with 
the  camera  tilted  down  by  approximately  20  degrees.  Comparison  of  Figures  4.7  and  4. 10 
reveal  the  significance  of  this  effect  Although  the  routines  which  conduct  the  edge 
extraction  and  object  detection  have  some  intrinsic  filtering  effect  this  significant  increase 
in  the  level  of  clutter  would  adversely  impact  subsequent  processing. 

Secondly,  this  large  tilt  angle  causes  a  distortion  in  the  non-vertical,  non¬ 
horizontal  image  lines.  Since  the  wire-frame  model  operates  on  the  prentise  that  the 
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Figure  4.9:  Grayscale  image  of  haUway  with  20  degree  dlt  angle 


Figure  4.10:  Gradient  image  of  hallway  with  20  degree  tilt  angle 


23 


viewing  is  done  parallel  to  the  floor,  the  ability  to  match  lines  between  the  model  and  image 
would  be  seriously  impaired. 

Obviously,  a  mounting  orientation  which  is  level  to  the  ground,  or  at  least  nearly 
level,  is  desirable  for  proper  image  processing.  The  concon  then  turns  to  what  does  the 
camera  see  and  is  this  useful.  After  some  experimentation,  a  very  satisfactory  setup  was 
achieved.  With  only  a  slight  downward  tilt  (<  2^*),  no  increase  in  specular  reflection  is 
apparent  in  the  images  while  an  object  comes  completely  into  view  at  a  range  of  just  under 
four  meters.  Since  the  sonars  have  a  maximum  effective  range  of  four  meters,  this  provides 
a  smooth  transition  between  close-in  operations  to  be  handled  by  sonar  and  long-range 
planning  via  vision. 

2.  Focal  Length  and  Field  of  View 

With  the  zoom  setting  held  constant,  camera  focal  length  will  remain  static  as 
well.  For  the  camera,  as  used  in  this  project,  the  focal  length  is  4. 16  centimeter  and  its  CCD 
element,  or  the  plane  onto  which  images  are  projected,  is  1.69  centimeters  square.  Figure 
4. 1 1  depicts  the  physical  significance  of  the  focal  length  (fl),  CCD  element  size,  and 
vertical  field  of  view  (FOV)  at  a  range  r,  if  looking  at  the  side  of  the  camera.  These  factors 
will  be  important  in  performing  range  and  dimension  calculations. 


Figure  4.1 1:  Depiction  of  focal  length,  CCD  element  size,  and  angle  delta 
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V.  UNKNOWN  OBJECT  RECOGNITION 


A.  EXTRACTING  UNKNOWN  OBJECTS 

With  the  basic  tools  described  previously,  it  is  now  possible  to  consider  the  integrated 
^proach  for  recognizing  the  presence  of  an  object  in  any  given  video  image  and  evaluating 
the  localized  object  for  range  and  dimension  infoimadon.  Functionally,  the  entire  process 
can  be  divided  into  two  parts,  image/model  processing  and  object  localization.  The 
implementation  on  Yamabico  by  programs  in  Appendix  B  is  described  in  the  following 
sections  and  includes  the  details  of  why  a  particular  action  is  necessary  and  how  it  is  carried 
out 

1.  Image/Model  Processing 

The  first  thing  which  must  be  accomplished  is  transferring  the  RGB  image  data 
from  the  video  framer  storage  format  into  a  one-dimensional  array  structure  used  during 
line  segment  processing.  Each  element  of  this  array  will  hold  information  on  a  pixel 
including  its  red,  green,  and  blue  intensity  levels,  allowing  for  rapid,  sequential  analysis  of 
each  pixel.  A  major  portion  of  the  image  processing,  including  grayscale  conversion,  edge 
determination,  and  line  fitting,  may  now  proceed.  The  approach,  as  detailed  in  Qiapter  IV, 
is  followed  without  modification. 

As  in  the  case  of  initial  image  line  generation,  the  creation  of  the  model  view 
follows  the  methodology  outlined  in  Chapter  IV.  A  single  file  is  devoted  to  storing  the  data 
describing  the  fifth  floor  hallway  in  which  the  robot  operates  and  is  en^loyed  in  generating 
the  three-dimensional  wire-frame  model  of  this  area.  The  two-dimensional  projection  of 
tiie  expected  view  in  this  world  is  then  created  based  on  the  input  robot  position  and 
orientation. 

Before  the  information  available  in  the  model  projection  can  be  applied  to  the 
input  image  for  patter^  !  inatching,  the  lines  making  up  the  model  representation  must  be 
frltered.  This  need  arises  because  the  methods  inherent  in  generation  of  the  model  list  of 


lines  will  initially  produce  lines  which  are  either  out  of  bounds  with  respect  to  the  image 
plane  area  or  by  their  very  nature  wUl  not  be  a  concern  to  object  detection.  This  results  in 
wasteful  comparisons  during  matching.  The  list  of  two^imensional  model  lines  is  not 
constrained  by  the  486  pixel  height  of  the  image  lines  and  consequently  a  model  line 
filtering  process  is  applied  to  this  list  which  eliminates  any  lines  which  lie  entirely  above  a 
height  of 486.  Another  characteristic  of  the  projection  routine  which  creates  the  model  view 
is  a  tendency  to  generate  a  number  of  very  short  line  segments  (some  that  are  only  a  fraction 
of  a  pixel  in  length).  Thus,  any  model  line  of  length  less  than  two  pixels  is  also  deleted  to 
reduce  the  number  of  comparisons  and  hence,  further  cut  computation  time.  One  additional 
test,  which  is  conducted  as  each  model  line  is  analyzed,  involves  determining  the  height  in 
the  projected  view  at  which  the  wall  meets  the  floor  or  the  ‘horizon*.  This  simply  consists 
of  keeping  track  of  the  lowest  horizontal  line  which  cuts  across  the  center  area  of  the 
projection  and  its  usefulness  will  be  covered  in  the  pattern  matching  discussion. 

Additionally,  the  model  lines  are  not  necessarily  contiguous  segments  and  in  fact 
what  appears  as  a  single  line  is  often  a  group  of  adjacent  segments.  The  problem  presented 
by  this  fragmentation  would  arise  when  the  actual  matching  process  is  initiated  because  an 
image  line  is  tested  for  end  point  inclusion  between  the  model  line’s  end  points.  Although 
a  image  line  may  be  a  valid  candidate  for  filtering,  it  would  be  dismissed  because  it  covers 
a  distance  greater  than  each  of  the  individual  segments.  Therefore,  adjacent  model  lines  are 
combined  into  one  continuous  line  segment  prior  to  initiation  of  the  matching  process. 

Facets  of  the  generated  image  lines  as  well  as  their  intended  application  in  the 
object  recognition  process  present  the  opportunity  for  elimination  prior  to  the  application 
of  the  model  lines  for  matching.  Unlike  the  pre-processing  conducted  on  the  model  lines, 
all  of  these  checks  can  be  accomplished  during  the  matching  of  the  individual  image  lines 
to  the  list  of  model  lines.  The  flrst  concerns  removal  based  solely  on  location  in  the  image 
plane.  Results  from  a  typical  line  fitting  run  will  include  a  few  lines  along  the  bottom  edge 
of  the  image  frame  which  carry  no  significance  with  regard  to  any  objects.  Therefore, 
image  lines  which  lie  entirely  below  a  height  of  two  pixels  are  marked  for  deletion.  Next, 


26 


lines  which  are  located  along  the  left  and  right  sides  are  also  set  for  deletion  since  die 
concern  of  object  recognition  generally  centers  on  the  view  directly  ahead.  The  final  filter 
follows  concepts  outlined  in  [KAH90]  where  computation  time  can  and  should  be  reduced 
by  focusing  the  processing  only  on  the  regions  of  concern.  In  the  case  of  this  work,  a  very 
significant  area  of  an  image  may  be  disregarded  because  the  robot  has  a  maximum  height 
Any  image  lines  located  entirely  above  this  value  will  not  have  an  impact  on  the  robot’s 
ability  to  navigate  safely  and  are  therefore  marked  for  deletion. 

With  all  of  the  model  and  image  line  pre-processing  completed,  the  actual 
elimination  of  expected  image  lines  by  pattern  matching  with  the  model  lines  may  be 
initiated.  Each  image  line  is  tested  against  the  filter  criteria  described  above,  and  then  it  is 
eliminated  either  through  Hltering  or  by  qualifying  as  a  match  to  a  model  line  with 
appropriate  end  point  inclusion,  or  it  remains  as  a  valid  candidate  for  being  a  part  of  an 
object’s  outline.  It  should  be  noted  that  although  the  model  lines  are  stored  in  two  lists,  one 
for  vertical  lines  and  the  other  for  the  rest,  the  image  lines  are  simply  contained  in  a  single 
list  in  the  order  in  which  they  were  fitted.  In  pursuit  of  minimized  computation  time,  it  is 
desirable  to  only  compare  a  vertical  image  line  to  the  vertical  model  lines  and  likewise  for 
horizontal  lines.  This  is  accomplished  by  determining  the  image  line  orientation  (votical, 
horizontal,  or  diagonal)  through  simply  assessing  its  phi  value  and  then  performing  the 
matching  agtunst  the  appropriate  model  list  During  this  test,  the  orientation  is  stored  for 
later  use  by  a  sorting  routine.  For  the  image  shown  in  Figure  5.1,  the  initial  extracted  line 
segments  are  presented  in  Figure  5.2  while  Figure  5.3  shows  the  lines  which  remain 
following  the  pattern  matching.  Notice  that  the  memos  posted  on  the  doors  are  not 
eliminated  since  it  would  not  be  appropriate  to  include  them  as  a  permanent  part  of  the 
hallway  model.  It  should  also  be  noted  that  although  these  lines  are  located  well  above  the 
maximum  height  of  the  robot,  they  still  appear  in  the  Hnal  image.  This  is  because  any  image 
line  (which  was  not  filtered  or  matched  to  a  model  line)  located  above  the  robot  height  will 
have  its  respective  data  structure  description  annotated  to  reflect  the  fact  that  it  is  not  of 
concern  as  an  obstacle  but  is  kept  in  the  list  of  lines  for  possible  post-analysis. 
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Figure  S.l:  Unanalyzed  grayscale  image 


Figure  52:  Initial  line  segments  for  image  in  Figure  S.l 


Figure  S.3:  Final  line  segments  for  image  in  Figure  S.l  following  filtering 


An  even  more  ambitious  approach  to  focusing  on  specific  regions  may  be  applied 
to  the  elimination  process  when  considering  one  of  the  base  assumptions  which  stated  that 
any  obstacle  encountered  will  be  resting  on  the  floor  and  not  suspended  above  the  floor.  It 
therefore,  is  a  direct  consequence  that  the  base  of  the  obstacle  will  have  its  edge  at  a  height 
that  in  all  instances  will  be  lower  than  the  height  at  which  the  wall  meets  the  floor. 
Additionally,  the  edges  which  comprise  the  sides  connecting  to  the  base  will  also  have  a 
portion  of  their  length  below  this  level.  The  height  of  this  meeting  point,  determined  during 
the  model  line  filtering,  is  a  known  value  and  consequently,  it  is  possible  to  consider  only 
image  lines  which  exist,  at  least  in  part,  below  this  horizon.  Figure  5.4  shows  the  lines 
which  wotild  remain  when  employing  this  approach.  Even  though  only  a  few  lines  remain, 
they  can  provide  all  the  information  necessary  to  eflectively  carry  out  object  analysis. 

2.  Object  Analysis 

Two  approaches  were  pursued  in  order  to  properly  localize  an  object  in  a 
processed  image.  The  first  assumed  that  the  robot  would  encounter  only  a  single  object 
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Figure  S.4:  Line  segments  for  image  in  Rguie  S.l  after  horizon  filtering 


while  the  second,  which  is  described  in  the  next  section,  lifted  this  restriction.  In  both  cases, 
the  derived  information  is  of  the  same  format  and  applicable  to  the  subsequent  calculations 
which  are  necessary  for  obstacle  avoidance.  The  former  method  operates  on  the  list  of 
remaining  image  lines  without  any  further  processing.  A  search  is  conducted  for  the  left¬ 
most  vertical  line  which  would  be  the  left  edge  of  the  box  and  a  corresponding  closest  line 
to  the  right  as  the  box’s  right  edge.  Next,  horizontal  lines  which  lie  within  the  confines  of 
the  left  and  right  sides  are  found  and  designated  as  the  bottom  and  top  of  the  object  This 
approach  is  actually  limited  in  its  robustness  because  the  presumption  that  only  one  object 
will  be  present  is  compromised  by  extraneous  lines  resulting  from  phenomena  such  as 
reflections,  shadowing,  and  light  between  doors. 

3.  Multiple  Object  Filtering 

Introducing  the  possibility  tfiat  more  than  one  object  will  be  present  in  an  image 
required  both  additional  processing  and  a  revised  approach.  Since  the  number  of  image 
lines  which  are  still  valid  candidates  for  making  up  the  object  outline  is  relatively  small,  it 
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proves  worth  while  to  devote  the  computation  time  necessary  to  sort  both  the  vertical  and 
horizontal  lines  once  at  the  start  of  object  analysis.  This  eliminates  repeated  searches 
through  the  entire  list  of  lines  which  would  otherwise  be  required.  Following  the  storage  of 
each  line’s  description  in  an  element  of  separate  arrays  for  vertical  and  horizontal  lines,  an 
implementation  of  a  quick-sort  algorithm  as  outlined  in  [MAN91],  is  applied  to  position  the 
lines  in  ascending  order,  going  left  to  right  or  bottom  to  top.  This  makes  it  possible  to  move 
through  the  lines  only  one  time  in  search  of  the  proper  combinations. 

With  the  lines  sorted,  the  basic  algorithm  used  to  localize  those  making  up  an 
object  is  as  follows:  Start  with  the  first  vertical  line  and  look  at  subsequent  vertical  lines 
until  one  is  found  with  the  condition  that  there  exists  a  horizontal  line  between  the  two.  If 
no  subsequent  line  was  found,  move  to  the  next  line  over  and  repeat.  Once  a  pair  of  lines 
has  been  found,  the  element  number  in  the  array  for  the  right  side  line  may  be  saved  and 
searching  for  the  next  object  continues,  beginning  with  the  next  element 

B.  RANGE  DETERMINATION 

Yamabico  is  capable  of  detecting  obstacles  at  a  range  of  up  to  four  meters  using  the 
installed  sonar  system.  However,  the  robot  is  essentially  ‘blind’  beyond  this  range  without 
the  benefit  of  other  sensors.  Provided  that  the  orthogonal  orientation  and  non-suspension 
assumptions  hold  true  for  each  object  it  is  possible  to  derive  range  information  from  an 
image  generated  by  the  vision  system  both  theoretically  and  empirically. 

1.  Theoretical  Range  Data 

Using  the  physical  hardware  constants  discussed  in  Chapter  IV,  it  is  possible  to 
calculate  the  range  to  an  object  through  analysis  of  the  object’s  base  in  a  video  image. 
Referring  to  Figure  S.S,  (3  is  the  angle  from  the  horizontal  to  the  bottom  edge  of  the  object, 
a  is  the  tilt  angle  of  the  camera  as  physically  mounted,  9  is  the  angle  from  the  vertical 
centerline  of  the  camera  image  (C^)  to  the  bottom  edge  of  the  object,  and  p  is  the  distance 
from  the  vertical  centerline  of  the  camera  image  to  the  bottom  edge  of  the  object  as 
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ngure  S.S:  Side  view  depiction  of  various  vision  system  parameters 


measured  on  the  CCD  element  in  pixels.  Figure  5.6  depicts  how  the  box  would  appear  in  a 
video  image  and  shows  p  on  the  image  plane.  With  this  information,  the  range  to  the  object 
is  calculated  as  follows: 

tan(6)  =  p/fl  0  =  arctan(p/n) 
h/r  =  tan(p)  =  tan(a  +  0) 

Combining  and  solving  for  r  gives ... 
r  =  h  /  (tan(a  +  aictan(p/fl))) 

A  plot  of  this  result,  using  a  tilt  angle  of  1.83  degrees,  is  shown  in  Hgure  5.7. 

L  Empirical  Range  Data 

Since  the  base  of  the  object  is  flush  with  the  floor,  the  edge  at  this  meeting  point 
will  appear  in  the  image  as  a  horizontal  line  at  a  given  height,  measured  along  the  vertical 
axis.  As  the  range  to  an  object  increases,  the  apparent  height  of  this  edge  will  increase,  at  a 


32 


decreasing  rate.  Figures  S.P  ''’•ough  5.11  demonstrate  this  phenomena,  as  the  first  two 
figures  reflect  the  difference  in  the  position  of  a  box  at  4.0  versus  4.5  meters  while  the 
second  two  show  the  same  0.5  meter  change  in  range,  but  from  8.0  to  8.5  meters  .  Qearly 


Figure  5.8:  Box  at  a  range  of  4.0  meters 


the  change  in  the  vertical  height  of  the  box’s  base  is  larger  at  the  four  meter  range  than  at 
eight  In  fact,  a  pixel  analysis  of  the  images  reveals  that  the  base  moved  from  a  vertical 
position  of  28.2  to  57.0  pixels  at  four  meters  while  it  only  moved  from  156.7  to  164.5  pixels 
at  the  eight  meter  range.  Figure  5.12  provides  a  plot  of  the  actual  range  of  a  box  in 
centimeters  versus  the  vertical  height  in  pixels  of  the  box’s  base  as  seen  in  an  image,  much 
like  the  theoretical  plot  of  Figure  5.7.  Two  separate  sets  of  data  (taken  on  the  same  box  but 
on  difrerent  days)  are  shown  to  demonstrate  the  fairly  consistent  nature  of  this  data.  As 
might  be  expected,  the  slope  of  the  curve  is  steeper  at  shorter  distances  since  a  change  in 
the  range  will  be  reflected  in  a  noticeable  edge  height  change  while  at  the  longer  distances 
a  much  larger  variation  in  range  would  be  required  to  detect  any  significant  edge  height 
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57.0 


Figure  5.9:  Box  a?  a  range  of  4.5  meters 


156.7 


Figure  5.10:  Box  at  a  range  of  8.0  meters 
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Figure  S.12;  Box  range  versus  the  height  of  its  base  in  an  image  for  two  separate  test  runs 
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movement  The  tendency  of  the  data  nins  to  drift  apart  at  longer  ranges  can  be  attributed  to 
the  diminishing  accuracy  which  is  caused  by  this  situation. 

Although  there  is  no  physical  cut-off  in  range  to  delineate  where  the  accuracies 
are  no  longer  adequate,  it  was  prudent  to  make  such  a  determination.  A  value  of  ten  meters 
was  chosen  because  variation  between  di^ering  base  heights  at  this  range  will  introduce  no 
more  than  a  10  centimeter  error,  permitting  safe  navigation  of  the  robot  using  vision  system 
data.  The  primary  concern,  however,  centers  on  how  well  the  theoretical  results  match  up 
against  the  raw  data.  Figure  5.13  provides  just  such  a  comparison,  with  the  theoretical 
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Figure  S.13:  Comparison  theoretical  versus  actual  data  points 


points  shown  plotted  as  a  solid  line  and  actual,  image-based  points  displayed  as  a  dotted 
line.  As  can  be  seen,  the  derived  formula  very  accurately  predicts  the  actual  vision  system 
output,  which  translates  into  a  precise  range  determination  capability  based  on  visual 
analysis. 
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C.  DIMENSION  DETERMINATION 

By  using  the  range  determined  in  the  previous  section  and  applying  trigonometry  in  a 
manner  similar  to  its  use  in  the  range  calculation,  it  is  a  relatively  simple  task  to  derive 
dimension  information  for  an  object  from  image  analysis.  Figure  5.14  depicts  an  object  in 


yo  - 

y  1  - 

Figure  S.14:  View  in  image  plane  during  detenninalion  of  height  A 

the  image  plane  with  the  bottom  and  top  at  a  vertical  position  of  y\  and  yo  prime 

respectively  and  a  distance  in-between  (or  height)  of  A.  A  side  view  of  this  situation  is 
provided  in  Figure  5.15  and  includes  the  focal  length  of  the  camera  and  the  projection  of 


Figure  5.13:  Side  view  ctf  image  injection  onto  CCD  element 
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yQ  and  pzime  as  yo  and  y|  (measured  in  pixels)  from  a  range  a.  The  following  derivation 
solves  for  the  object  height  (A): 


yp  _  yp  yjj  _  yp^ 

a  /  fl 

•  -1  1  •  -  yi  * 

similarly,  y|=  _ 

fl 

A  =  yi”  yb  =  =  (yi-yp)(^) 

fi  fl 

Since  yo  and  yj  are  given  in  pixels,  a  conversion  to  centimeters  is  necessary . . . 
CCD  physical  size  =  1.69  cm  and  CCD  pixel  size  =  486  pixels 
conversion  =  1.69  /  486  =  0.00348  cm/pixel 


As  an  example.  Figure  S.  14  depicts  a  hallway  image  with  a  box  placed  at  a  distance  of 
507  cm  from  the  camera.  A  pixel  analysis  reveals  that  the  top  and  bottom  are  located  along 
the  vertical  axis  at  48  and  154  pixels  while  the  sides  are  at  206  and  276  pixels  along  the 
horizontal  axis.  The  differences  provide  a  height  of  106  pixels  and  a  width  of  70  pixels. 
Applying  the  above  formula,  the  box  dimensions  are  estimated  to  be  44x29.5  cm.  The 
actual  dimensions  of  the  box  are  44x29  cm,  so  this  approach  clearly  provides  very  accurate 
results. 
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Figure  S.14;  Box  location  in  an  image  described  by  pixels 
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VI.  OBSTACLE  AVOIDANCE 


A.  IMAGE  ANALYSIS  INTERPRETATION 

Following  object  evaluation,  the  left  and  right  sides  of  the  object  as  known  values  and 
the  approach  to  applying  this  information  in  obstacle  avoidance  is  fairly  sinqple.  Five 
possible  situations  can  exist  with  regard  to  the  ‘best*  path  for  avoidance  by  a  minimum 
distance  L.  The  first  two  cases  occur  when  the  entire  obstacle  is  situated  more  than  L  to  the 
left  or  right  of  the  current  robot  path  and  consequently,  do  not  require  maneuvering.  In  the 
third  scenario,  an  obstacle  may  be  positioned  such  that  the  current  path  would  bisect  it  This 
necessitates  basing  the  decision  to  shift  left  or  right  on  the  presence  of  other  obstacles  or 
the  proximity  to  surrounding  enclosures.  Finally,  the  obstacle  may  cross  the  path,  extending 
more  to  one  side  than  the  other.  In  these  instances,  the  tendency  would  be  to  shift  to  the  side 
which  causes  the  least  significant  movement  away  from  the  desired  trajectory.  Once  again, 
other  factors  might  be  considered. 

In  general,  however,  the  objective  is  stiU  to  maneuver  around  the  obstacle  by  at  least 
L.  Since  the  camera  is  mounted  in  line  with  the  center  line  of  the  robot,  it  is  reasonable  to 
consider  the  horizontal  center  of  the  images  it  generates  to  be  in  line  with  the  current  robot 
path.  The  exact  same  relationship  which  was  used  in  determining  the  obstacle's  dimensions 
can  also  be  applied  to  calculating  the  distance  (D)  from  the  center  of  the  image  (or  robot 
path)  to  the  side  along  which  the  robot  will  pass.  Corresponding  to  the  cases  discussed 
above  and  referring  to  Figure  6. 1 ,  a  value  of  D  >  L  with  the  object  entirely  to  one  side  would 
mean  that  the  object  wiU  not  be  of  concern  while  D  <  L  would  require  a  shift  by  a  distance 
of  L±D.  The  convention  used  in  the  implementation  is  that  a  shift  to  the  right  is  positive 
and  a  shift  to  the  left  is  negative. 

B.  PATH  GENERATION 

At  this  point,  the  information  available  from  the  vision  system,  as  currently 
implemented,  provides  the  data  necessary  for  the  robot  to  alter  its  current  path  such  that  an 
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D  >  L  with  obstacle  entirely  to  one  side  •>  Obstacle  does  not  force  change  in  padi 


L 

D  <  L  with  obstacle  entirely  to  one  side  ->  Obstacle  forces  shift  of  L-D 


L 

D  <  L  with  obstacle  directly  in  path  ->  Obstacle  forces  shift  of  L+D 
Figure  6.1:  Variation  in  obstacle  avoidance  maneuvns 
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obstacle  will  be  avoided  by  a  safe  distance  L.  This  essentially  amounts  to  an  ‘intelligent’ 
lane  change.  It  is  possible,  however,  to  enhance  this  maneuver  and  return  to  the  original 
path.  By  enabling  a  side  looking  sonar  while  passing  along  side  the  obstacle,  its  depth  can 
be  determined  and  a  subsequent  shift  back  to  the  initial  path  may  safely  take  place.  The 
combination  of  the  two  sensors  would  lead  to  the  following  general  algorithm: 

-  Grab  an  image  while  traveling  along  a  particular  path. 

-  Perform  image  analysis  on  the  image. 

-  If  no  object  is  detected,  continue  on  the  current  path. 

-  If  an  object  is  detected,  analyze  object  for  range  and  dimension  information. 

-  Determine  the  ‘safest’  and  least  significant  maneuver  and  compute  the  required 
distance  to  shift  left  or  right 

-  Define  a  new  path  based  on  the  above  input  and  transition  to  it 

•  Return  to  the  original  path  once  past  the  object,  as  detected  by  side-looking  sonar. 

Essentially  all  of  the  elements  in  this  approach  have  been  covered  in  detail  with  the 
exception  of  the  method  used  to  define  a  path  and  the  subsequent  transition  to  it  Path 
definition  is  a  veiy  straight  forward  task  under  MML  and  transitioning  between  paths  is 
even  easier.  First  a  configuration  must  be  defined.  This  is  accomplished  through  a  call  to 
the  function  defjoor^guration  with  input  arguments  of  x,  y,  theta,  kappa  and  name, 
where  the  first  four  arguments  are  described  in  Qiapter  m  and  name  is  an  arbitrary,  yet 
unique,  label  given  to  each  configuration.  Next  a  path  which  will  include  this  configuration 
is  declared  via  the  line  function  with  a  single  input  argument  of  the  configuration  name. 
Once  line  has  been  invoked,  MML  will  automatically  determine  a  smooth  path  for 
transitioning  to  the  new  path  as  well  as  provide  the  locomotion  control  necessary  for 
steering  the  robot  along  these  paths. 

As  an  example,  if  avoidance  requires  moving  left  or  right  a  distance  A  to  a  paraUel 
path  as  shown  in  Figure  6.2,  the  actual  commands  to  the  robot  would  be  as  follows,  where 
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a  call  to  the  getjrobO  function  will  provide  the  current  robot  configuration  in  die  global 
coordinate  system: 

defjcor0guration(O,  —A,  0, 0.  &locai; 

ger_ro60(&config) 

line(compose(&cotdig,  Alocal,  Aconfig)) 

There  are  two  important  aspects  to  note  in  this  series  of  commands.  First,  the  call  to 
d^jsortfiguration  simply  defines  an  orientation  which  is  physically  A  to  the  right  or  left  of 
the  robot  This  is  based  on  the  local  frame  of  refnence  where  x  is  in  the  direction  of  motion 
and  corresponds  to  a  theta  of  0°,  leaving  the  y  axis  to  describe  the  distance  to  either  side. 
Second,  as  discussed  in  Chapter  IV,  the  compose  function  must  be  en^loyed  in  order  to 
convert  this  locally  based  orientation  derived  from  the  image  analysis  into  the  global  frame 
of  reference  in  which  the  robot  operates.  The  shift  back  to  the  original  path  would  require 
the  identical  three  calls  with  the  exception  of  using  A  in  the  call  to  def_configuration. 


Figure  6.2:  Obstacle  avoidanoe  employing  image  analysis  input  for  situation  described  in  Rgure  6.1x 
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VII.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

1.  Results 

Experiments  enq)loying  the  integrated  system  were  successful  in  a  number  of 
regards.  The  accuracies  with  respect  to  dimension  and  range  determination  certainly 
exceed  the  expectations  which  were  present  upon  commencing  this  work  and  the  pattern 
matching  implementation  appears  to  provide  consistent  object  recognition.  Unfcntunately, 
testing  under  fully  autonomous  conditions  was  not  feasible  due  to  the  lack  of  an  on-board 
image  processing  capability.  Even  without  the  capability  to  identify  obstacles  and  ascertain 
depth  information,  the  robot  gains  increased  knowledge  about  the  world  in  which  it  is 
operating  compared  to  operating  solely  off  of  sonar  output 

2.  Concerns 

Despite  the  generally  favorable  results  from  this  implementation,  a  number  of 
factors  are  still  a  concern.  As  with  most  vision  systems,  variations  in  lighting  can  have  an 
adverse  effect  on  the  ability  to  properly  extract  line  segments,  resulting  in  improper  object 
analysis.  Another  aspect  which  may  hinder  the  processing  is  the  dependency  on  accurate 
position  information  for  generating  the  expected  view  from  the  model.  Robot  odometry  is 
subject  to  errors  due  to  floor  unevenness  and  wheel  slippage  which  accumulate  with  time 
if  left  uncorrected.  The  need  for  stable  robot  locomotion  to  prevent  fluctuations  in  the  tilt 
angle  is  also  a  critical  factor,  although  Yamabico's  movements  are  very  smooth.  Finally,  if 
the  robot  is  travelling  at  medium  to  high  speed,  the  processing  time  may  prohibit  the  image 
understanding  system  from  providing  the  necessary  avoidance  information  rapidly  enough 
to  ensure  a  safe  and  timely  maneuver. 
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B.  RECOMMENDATIONS 


1.  Hardware 

Obviously,  the  biggest  physical  limitation  to  this  system  is  the  requirement  to 
have  video  cables  attached  to  the  robot  in  order  to  grab  an  image.  Although  the  ultimate 
goal  is  to  perform  all  processing  on  board  the  robot  with  dedicated  hardware  specifically 
designed  for  this  task,  a  wireless  video  link  would  be  an  economical,  yet  practical  interim 
solution.  An  added  beneflt  to  this  upgrade  is  that  when  the  processing  capability  is  available 
on  the  robot,  the  wireless  link  could  stiU  be  used  for  remotely  monitoring  what  the  robot  is 
seeing.  A  pivoting  camera,  possibly  with  auto*focus  capability,  would  certainly  enhance 
the  usefulness  of  vision  as  a  sensor  by  drastically  reducing  the  field  of  view  and  the 
directional  limitations  imposed  by  a  static  mounting  and  the  constant  focus.  Additionally, 
an  inclinometer  mounted  to  the  vehicle  could  be  used  to  provide  accurate  tilt  angle 
measurements. 

2.  Software 

Another  potential  approach  to  verifying  the  tilt  angle  would  be  to  base  its 
calculation  on  interpretation  of  each  image.  Just  as  range  to  an  object  is  computed  by  the 
height  of  its  base  in  an  image,  the  reverse  could  be  done,  in  that  knowledge  of  the  height 
where  the  wall  meets  the  floor  and  the  range  to  the  wall  is  sufficient  for  determining  the  tilt 
angle.  I^obably  the  most  promising  concept  is  the  use  of  the  recently  implemented 
automated  cartography  capability  for  generating  a  three-dimensional  wire-frame  model  of 
a  previously  unknown  environment  By  mapping  the  walls  which  enclose  the  robot  and 
transforming  this  data  into  a  ‘global’  frame  of  reference,  the  model  btulding  routines  could 
be  directly  invoked  to  create  a  three-dimensional  world  model  with  an  arlntrary  value  for 
the  height  of  the  enclosure,  thus  permitting  use  of  the  image  understanding  system  in  what 
was  previously  an  unknown  environment 
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APPENDIX  A  -  MODEL  AND  EDGE  EXTRACTION  ROUTINES 


The  following  routines  provide  implementation  for  the  creation  of  the  fifth  floor  model,  the 
transformation  of  a  three-dimensional  view  from  a  position  in  the  model  onto  a  two- 
dimensional  plane,  image  storage  structures,  and  edge  extraction  of  video  images.  The  files 
included  are  the  following: 

modelSth.h,  modelgraphics.h,  modelvisibility.h,  modend-Kl.h,  cdgesupporth, 
npsimagesupon.h 


/*  FILE:  5th. h 

AUTHORS:  LT  Jeunes  Stein  /  LT  Mark  DeClue 

THESIS  ADVISOR:  Dr.  Kanayama 
CALLS  TO  FILES:  2d+.h 


COMMENTS:  This  is  the  construction  file  for  the  2d+  model  of  the 
5th  floor  Spanagel  Hall  (1st  half  only  -  up  to  glass  double  doors) .  All 
coordinates  are  in  inches  while  all  angles  are  in  degrees. 

The  main  function  •make_world*  is  called  to 
build  the  model  using  function  calls  to  file  2d+.h.  Type  definitions  for 
WORLD,  POLYHEDRON,  POLYGON,  and  VERTEX  can  be  found  at  the  top  of  this  file 
also. 

Notice  that  the  floor  of  HI  is  one  huge,  concave  polygon  which 
makes  up  the  floor  to  the  hallway  as  well  as  all  of  the  office  floors.  To 
this 

floor  numerous  ceilings  are  added  for  offices,  door  jams,  and  main 
corridors . 

Doors,  lights,  and  molding  strips  are  then  added  to  the  model  as  separate 
polyhedra . 

*/ 


WORLD  *make_world( ) 

{ 

WORLD  *W; 

POLYHEDRON  *H1,  *H2.  *H3,  *H4,  ‘HS,  *H6,  *H7,  *H8,  *H9,  *H10,  *H11,  *H12, 

*H13,  *H14,  *H15,  *H16.  *H17,  *H18.  *H19,  *H20,  *H21,  *H22.  *H23,  *H24, 

*H25,  *H26,  *H27,  *H28,  *H29,  •H30,  *H31,  *H32,  *H33,  *H34,  *H35,  *H36, 

*H37,  *H38.  *H39.  *H40,  *H41,  *H42,  *H43,  *H44,  *H45,  *H46,  *H47 ,  *H48; 

POLYGON  *H1P1,  *H1P2,  *H1P3, 

*H1P4,  *H1P5  ,*H1P6,  *H1P7,  *H1P8,  *H1P9,  *H1P10,  *H1P11,  *H1P12, 


•H1P13, 

♦H1P14. 

*H1P15, 

•H1P16,  *H1P17, 

•H1P18, 

•H1P19, 

•H1P20, 

♦H1P21, 

*H1P22, 

•H1P23, 

♦H1P24, 

•H1P25.  *H1P26, 

•H1P27, 

*H1P28, 

*H1P29, 

*H1P30, 

*H1P31. 

•H1P32, 

•H1P33, 

•H1P34.  •H1P35, 

♦H1P36. 

♦H1P37, 

•H1P38, 

•H1P39, 

*H1P40, 

•H1P41, 

•H1P42, 

*H1P43,  *H1P44, 

*H1P45, 

•H1P46, 

•H1P47, 

*H1P48, 
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•H1P49,  ‘HIPSO,  *H1P51,  •H1P52,  *H1P53.  •H1P54,  *H1P55,  ‘HlPSe,  ‘HIPS?, 
*H1P58,  *H1P59,  *H1P60,  *H1P61,  •H1P62,  *H1P63,  •H1P64,  *H1P65, 


*H2P1,  *H2P2,  •H3P1,  •H3P2.  •H4P1,  *H4P2,  *H5P1,  *H5P2, 

*H6P1,  *H7P1,  *H7P2,  *H8P1,  •H8P2.  •H9P1,  •H9P2,  -HlOPl,  *H10P2, 


*H11P1.  •H11P2. 

•H12P1, 

*H12P2. 

*H13P1 , 

•H13P2, 

•H14P1, 

’'H14P2, 

•H15P1, 

*H15P2,  *H16P1, 
•H20P1,  *H20P2 

•H16P2, 

i 

•H17P1. 

•H17P2, 

•H18P1, 

•H18P2, 

*H19P1, 

•H19P2, 

•H21P1.  -;I21P2, 

•H22P1, 

•H22P2. 

•H23P1. 

*1:2  3  P2, 

•H24P1, 

•H24P2, 

*H25P1, 

*H25P2,  •H26P1. 
•H30P1,  *H30P2 

•H26P2, 

*H27P1. 

•H27P2, 

•H28P1, 

•H28P2, 

•H29P1, 

*H29P2, 

•H31P1,  *H31P2. 

*H32P1. 

*H32P2. 

•H33P1. 

•H33P2, 

•H34P1, 

•H34P2, 

*H35P1, 

•H35P2,  *H36P1, 

•H36P2, 

•H37P1, 

•H37P2. 

*H38P1, 

•H38P2, 

*H39P1, 

•H39P2, 

*H40P1,  -H40P2, 

*H41P1, 

•H41P2. 

•H42P1, 

•H42P2, 

•H43P1, 

•H43P2, 

•H44P1, 

*H44P2,  *H45Pi. 
last_p; 

•H45P2. 

•H46P1. 

*H46P2. 

*H47P1, 

•H47P2, 

•H48P1, 

•H48P2, 

VERTEX  *H1P1V1,  *H1P1V2,  *H1P1V3.  •H1P1V4,  *H1P1V5,  *H1P1V6,  *H1P1V7, 
•H1P1V8,  •H1P1V9, *H1P1V10,  *H1P1V11.  •H1P1V12,  *H1P1V13,  •H1P1V14, 
*H1P1V15, *H1P1V16, *H1P1V17.  ‘HIPIVIS,  *H1P1V19,  *H1P1V20, 

*H1P1V21, 

*H1P1V22,  •H1P1V23,  *H1P1V24,  *H1P1V25,  ‘HlPme,  •H1P1V27, 

•H1P1V28, 

*H1P1V29, *H1P1V30, *H1P1V31,  *H1P1V32,  *H1P1V33,  *H1P1V34, 

•H1P1V35, 

♦H1P1V36, *H1P1V37, *H1P1V38.  *H1P1V39,  *H1P1V40,  *H1P1V41, 

•H1P1V42, 

•H1P1V43, *H1P1V44, *H1P1V45,  *H1P1V46,  *H1P1V47,  *H1P1V48, 

*H1P1V49, 

•H1P1V50, *H1P1V51, *H1P1V52,  *H1P1V53,  *H1P:V54,  *H1P1V55, 

•H1P1V56, 

•H1P1V57, *H1P1V58, *2:1P1V59,  ‘H1P1V60,  *H1P1V61,  *H1P1V62. 

‘H1P1V63, 

•H1P1V64, *H1P1V65, ‘HlPlVee,  *H1P1V67,  *H1P1V68,  *H1P1V69, 

•H1P1V70, 

*HlPlV2a,  *HlPlV2b,  *HlPlV2c,  *HlPlV2d,  *HlPlV2e,  *HlPlV2f, 

*HlPlV4a,  *HlPlV4b,  *HlPlV4c,  *HlPlV4d,  *HlPlV4e,  •HlPlV4f, 

*HlPlV6a,  *HlPlV6b,  *HlPlV6c,  *HlPlV6d,  *HlPlV6e,  *HlPlV6f, 

*HlPlV8a,  *HlPlV8b,  *HlPlV8c,  *HlPlV8d,  *HlPlV8e,  ‘HlPlVef, 

•HlPlVlOa,  ‘HlPlVlOb,  ‘HlPlVlOc,  *HlPlV10d,  ‘HlPlVlOe,  *HlPlV10f, 
*HlPlV12a.  *HlPlV12b,  •HlPlV12c,  *HlPlV12d,  *HlPlV12e,  *HlPlV12f, 
*HlPlV14a,  *HlPlV14b,  •HlPlV14c,  *HlPlV14d,  *HlPlV14e,  *HlPlV14f, 
•HlPlVlSa,  *HlPlV16b,  *HlPlV16c.  ‘HlPlVied,  *HlPlV16e,  *HlPlV16f, 
*HlPlV18a,  *HlPlV18b,  *HlPlV18c,  *HlPlV18d,  *HlPlV18e,  *HlPlV18f, 
*HlPlV20a,  *HlPlV20b,  *HlPlV20c,  *HlPlV20d,  *HlPlV20e,  *HlPlV20f, 
*HlPlV22a,  *HlPlV22b, 

*HlPlV24a,  *HlPlV24b.  *HlPlV24c,  *HlPlV24d,  *HlPlV24e,  *HlPlV24f, 
*HlPlV26a.  *HlPlV26b,  *HlPlV26c,  *HlPlV26d.  *HlPlV26e,  *HlPlV26f, 
*HlPlV28a,  *HlPlV28b,  *HlPlV28c,  *HlPlV28d,  *HlPlV28e,  *HlPlV28f, 
*HlPlV30a,  *HlPlV:Ob,  *HlPlV30c,  *HlPlV30d.  *HlPlV30e,  *HlPlV30f, 
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*HlPlV32a,  *HlPlV32b. 
*HlPlV34a,  *HlPlV34b, 
*HlPlV36a,  *HlPlV36b, 
*HlPlV38a,  *HlPlV38b, 
*HlPlV40a,  *HlPlY40b, 
*HlPlV42a,  *HlPlV42b. 
*HlPlV44a,  •HlPlV44b. 
*HlPlV46a.  *HlPlV46b. 
*HlPlV48a,  *HlPlV48b, 
•HlPlVBOa,  *HlPlV50b, 
*HlPlV52a.  *HlPlV52b. 
*HlPlV55a.  *HlPlV55b, 
*HlPlV58a,  *HlPlV58b. 
*HlPlV60a,  *HlPlV60b, 
•HlPlV63a,  *HlPlV63b. 
*HlPlV63g. 

*HlPlV65a,  *HlPlV65b, 
*HlPlV65g, 

*HlPlV68a,  *HlPlV68b, 


H1P1V32C,  *HlPlV32d, 
H1P1V34C,  •HlPlV34d, 
H1P1V36C.  *HlPlV36d, 
H1P1V38C,  *HlPlV38d, 
H1P1V40C.  *HlPlV40d, 
H1P1V42C,  *HlPlV42d, 
H1P1V44C,  *HlPlV44d, 
H1P1V46C,  *HlPlV46d, 
H1P1V48C.  *HlPlV48d, 
HlPlVSOc,  ‘HlPlVSCd, 
H1P1V52C,  *HlPlV52d, 
H1P1V55C,  -HlPlVEBd, 
H1P1V58C,  •HlPlV58d, 
HiPiveoc,  ‘Hipiveod, 
H1P1V63C,  *HlPlV63d, 

H1P1V65C.  ‘HlPlVeSd, 

H1P1V68C.  *HlPlV68d, 


*HlPlV32e,  *HlPlV32f, 
*HlPlV34e,  *HlPlV34f, 
*HlPlV36e,  *HlPlV36f, 
*HlPlV38e,  *H1P1V38£, 
*HlPlV40e,  *HlPlV40f, 
*HlPlV42e.  *HlPlV42f, 
*HlPlV44e,  *HlPlV44f, 
•HlPlV46e,  *H1P1V46£, 
•HlPlV48e,  *HlPlV48f, 
•HlPlVBOe,  ‘HlPmO^, 
•HlPlV52e,  *HlPlV52f, 
*HlPlV55e,  *HlPlV55f, 
*HlPlV58e,  *HlPlV58f, 
•HlPlveOe.  ‘HlPlveOf, 
*HlPlV63e,  *HlPlV63f, 

*HlPlV65e,  *HlPlV65f, 

*HlPlV68e,  *HlPlV68f, 


•H1P2V1,  *H1P2V2.  •H1P2V3,  *H1P2V4. 

•H1P3V1,  *H1P3V2,  *H1P3V3,  *H1P3V4, 

*H1P4V1,  *H1P4V2,  *H1P4V3,  *H1P4V4, 

♦H1P5V1,  *H1P5V2,  *H1P5V3,  *H1P5V4, 

•H1P6V1,  •H1P6V2,  *H1P6V3,  *H1P6V4, 

*H1P7V1,  *H1P7V2,  *H1P7V3,  *H1P7V4, 

•H1P8V1,  *H1P8V2,  *H1P8V3,  *H1P8V4, 

•H1P9V1,  *H1P9V2,  *H1P9V3.  *H1P9V4, 

•HIPIOVI,  *H1P10V2,  *H1P10V3,  *H1P10V4, 

*H1P11V1,  *H1P11V2,  ‘H1P11V3,  *H1P11V4, 

♦H1P12V1,  *H1P12V2,  *H1P12V3,  *H1P12V4, 

•H1P13V1,  *H1P13V2,  *H1P13V3,  *H1P13V4, 

•H1P14V1,  *H1P14V2,  *H1P14V3,  *H1P14V4, 

‘H1P15V1,  *H1P15V2,  *H1P15V3,  *H1P15V4, 

•H1P16V1,  *H1P16V2,  *H1P16V3,  *H1P16V4, 

♦H1P17V1,  *H1P17V2,  *H1P17V3,  *H1P17V4, 

•H1P18V1,  *H1P18V2,  *H1P18V3,  *H1P18V4, 

•H1P19V1,  ‘H1P19V2,  *H1P19V3,  *H1P19V4, 

•H1P20V1,  •H1P20V2,  *H1P20V3,  *H1P20V4, 

•H1P21V1,  •H1P21V2,  *H1P21V3,  *H1P21V4, 

•H1P22V1,  *H1P22V2,  *H1P22V3,  *H1P22V4, 

♦H1P23V1,  •H1P23V2,  *H1P23V3,  *H1P23V4, 

•H1P24V1.  *H1P24V2.  *H1P24V3,  *H1P24V4, 

•H1P25V1,  *H1P25V2,  *H1P25V3,  *H1P25V4, 

‘H1P26V1,  *H1P26V2,  •H1P26V3.  *H1P26V4, 

♦H1P27V1.  *H1P27V2,  *H1P27V3,  *H1P27V4, 

•H1P28V1,  *H1P28V2,  *H1P28V3,  *H1P28V4, 

*H1P29V1.  *H1P29V2,  •H1P29V3,  •H1P29V4, 

•H1P30V1,  *H1P30V2,  •H1P30V3,  *H1P30V4, 

•H1P31V1,  *H1P31V2,  *H1P31V3,  *H1P31V4,  *H1P31V5, 
•H1P32V1,  *H1P32V2,  *H1P32V3,  *H1P32V4,  ‘H1P32V5, 
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•H1P33V1, 

•H1P33V2. 

‘H1P33V3. 

•H1P33V4. 

•H1P34V1. 

•H1P34V2. 

*H1P34V3, 

•H1P34V4, 

•H1P35V1. 

•H1P35V2, 

•H1P35V3, 

•H1P35V4, 

•H1P36V1, 

•H1P36V2. 

•H1P36V3. 

•H1P36V4. 

•H1P37V1, 

•H1P37V2. 

•H1P37V3, 

•H1P37V4, 

•H1P38V1, 

•H1P38V2. 

•H1P38V3. 

•H1P38V4. 

•H1P39V1, 

•H1P39V2, 

•H1P39V3, 

•H1P39V4, 

‘H1P40V1, 

•H1P40V2, 

•H1P40V3, 

•H1P40V4, 

‘H1P41V1, 

•H1P41V2, 

•H1P41V3, 

*H1P41V4. 

•H1P42V1, 

•H1P42V2, 

•H1P42V3. 

‘H1P42V4, 

•H1P43V1, 

*H1P43V2, 

‘H1P43V3, 

•H1P43V4. 

*H1P44V1, 

•H1P44V2, 

•H1P44V3, 

•H1P44V4. 

•H1P45V1, 

•H1P45V2, 

•H1P45V3, 

•H1P45V4. 

•H1P46V1, 

•H1P46V2, 

•H1P46V3, 

•H1P46V4, 

*H1P47V1, 

•H1P47V2. 

•H1P47V3. 

•H1P47V4. 

•H1P48V1, 

•H1P48V2. 

•H1P48V3, 

•H1P48V4. 

♦H1P49V1, 

•H1P49V2. 

‘H1P49V3, 

•H1P49V4, 

•H1P50V1, 

•H1P50V2, 

•H1P50V3. 

•H1P50V4, 

•H1P51V1, 

•H1P51V2, 

•H1P51V3. 

•H1P51V4, 

•H1P52V1, 

•H1P52V2, 

•H1P52V3. 

•H1P52V4. 

•H1P53V1, 

♦H1P53V2. 

•H1P53V3. 

•H1P53V4. 

•H1P54V1, 

•H1P54V2, 

•H1P54V3, 

♦H1P54V4. 

•H1P55V1, 

•H1P55V2, 

•H1P55V3, 

•H1P55V4, 

‘H1P56V1, 

•H1P56V2, 

*H1P56V3, 

•H1P56V4, 

*H1P57V1, 

♦H1P57V2. 

•H1P57V3, 

♦H1P57V4, 

♦H1P58V1, 

•H1P58V2, 

•H1P58V3, 

•H1P58V4, 

•H1P59V1, 

•H1P59V2, 

•H1P59V3, 

•H1P59V4, 

•H1P60V1, 

•H1P60V2, 

•H1P60V3, 

•H1P60V4, 

•H1P61V1, 

•H1P61V2, 

•H1P61V3, 

•H1P61V4, 

•H1P62V1, 

•H1P62V2, 

•H1P62V3, 

•H1P62V4, 

♦H1P63V1, 

•H1P63V2, 

•H1P63V3, 

•H1P63V4, 

•H1P64V1, 

•H1P64V2, 

♦H1P64V3, 

♦H1P64V4, 

♦H1P65V1, 

•H1P65V2, 

•H1P65V3, 

•H1P65V4, 

•H2P1V1. 

•H2P1V2, 

♦H2P1V3, 

♦H2P1V4, 

•H2P2V1, 

•H2P2V2, 

*H2P2V3,  *H2P2V4, 

•H3P1V1, 

•H3P1V2, 

•H3P1V3, 

•H3P1V4, 

•H3P2V1, 

*H3P2V2, 

•H3P2V3,  *H3P2V4. 

•H4P1V1. 

♦H4P1V2, 

♦H4P1V3. 

•H4P1V4, 

*H4P2V1, 

•H4P2V2, 

•H4P2V3,  *H4P2V4. 

•H5P1V1, 

•H5P1V2, 

♦H5P1V3 , 

•H5P1V4, 

♦H5P2V1 , 

•H5P2V2, 

•H5P2V3.  *H5P2V4, 

•H6P1V1, 

•H6P1V2, 

*H6P1V3, 

•H6P1V4, 

•H7P1V1, 

•H7P1V2, 

•H7P1V3, 

•H7P1V4, 

•H7P2V1, 

♦H7P2V2, 

•H7P2V3,  *H7P2V4. 

•H8P1V1, 

•H8P1V2, 

•H8P1V3, 

•H8P1V4, 

•H8P2V1 , 

•H8P2V2, 

♦H8P2V3,  *H8P2V4. 

•H9P1V1, 

*H9P1V2, 

•H9P1V3, 

•H9P1V4, 

•H9P2V1, 

•H9P2V2, 

•H9P2V3,  *H9P2V4, 

•HIOPIVI, 

‘H10P2V4, 

•H10P1V2, 

•H10P1V3,  *H10P1V4, 

•H10P2V1, 

•H10P2V2, 

•H10P2V3, 

•HllPlVl, 

‘H11P2V4, 

*H11P1V2, 

•H11P1V3,  •H11P1V4, 

•H11P2V1, 

•H11P2V2, 

•H11P2V3, 

•H12P1V1, 

‘H12P2V4, 

♦H12P1V2, 

•H12P1V3,  *H12P1V4, 

•H12P2V1, 

‘H12P2V2, 

•H12P2V3, 

•H13P1V1, 

♦H13P2V4, 

*H13P1V2, 

‘H13P1V3,  *H13P1V4, 

•H13P2V1, 

‘H13P2V2, 

•H13P2V3, 

•H14P1V1. 

•H14P1V2, 

•H14P1V3,  *H14P1V4, 

•H14P2V1. 

•H14P2V2, 

‘H14P2V3, 
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•H14P2V4. 

•H15P1V1, 

•H15P2V4, 

•H16P1V1, 

•H16P2V4. 

•H17P1V1, 

•H17P2V4. 

•H18P1V1, 

•H18P2V4. 

•H19P1V1, 

•H19P2V4. 

♦H20P1V1, 

•H20P2V4, 

•H21P1V1. 

•H21P2V4, 

•H22P1V1, 

•H22P2V4, 

•H23P1V1, 

*H23P2V4. 

‘H24P1V1. 

•H24P2V4. 

•H25P1V1, 

•H25P2V4, 

*H26P1V1, 

*H26P2V4, 

*H27Pm, 

•H27P2V4, 

♦H28P1V1, 

•H28P2V4, 

•H29P1V1. 

•H29P2V4, 

*H30P1V1, 

•H30P2V4, 

•H31P1V1, 

•H31P2V4, 

•H32P1V1, 

•H32P2V4, 

•H33P1V1, 

•H33P2V4, 

•H34P1V1, 

•H34P2V4, 

•H35P1V1, 

*H35P2V4, 

•H36P1V1, 

•H36P2V4, 

♦H37P1V1, 

*H37P2V4, 

♦H38P1V1, 

•H38P2V4, 

♦H39P1V1, 

‘H39P2V4, 


•H15P1V2, 

‘H16P1V2. 

♦H17P1V2. 

•H18P1V2, 

•H19P1V2, 

♦H20P1V2, 

•H21P1V2, 

*H22P1V2. 

•H23P1V2, 

•H24P1V2. 

•H25P1V2. 

•H26P1V2, 

•H27P1V2, 

*H28P1V2, 

•H29P1V2, 

•H30P1V2. 

•H31P1V2, 

♦H32P1V2, 

•H33P1V2. 

♦H34P1V2, 

♦H35P1V2, 

♦H36P1V2, 

•H37P1V2, 

•H38P1V2, 

•H39P1V2, 


•H15P1V3. 

*H16P1V3. 

‘H17P1V3, 

•H18P1V3, 

•H19P1V3, 

*H20P1V3, 

♦H21P1V3, 

♦H22P1V3, 

•H23P1V3, 

*H24P1V3, 

*H25P1V3, 

•H26P1V3, 

•H27P1V3, 

•H28P1V3, 

•H29P1V3, 

♦H30P1V3. 

•H31P1V3, 

♦H32P1V3, 

•H33P1V3, 

♦H34P1V3, 

•H35P1V3, 

•H36P1V3, 

•H37P1V3, 

♦H38P1V3, 

*H39P1V3, 


•H15P1V4. 

•H16P1V4. 

•H17P1V4. 

•H18P1V4. 

•H19P1V4, 

•H20P1V4. 

•H21P1V4. 

*H22P1V4< 

•H23P1V4, 

•H24P1V4, 

*H25P1V4, 

•H26P1V4, 

•H27P1V4, 

•H28P1V4, 

•H29P1V4, 

♦H30P1V4 

♦H31P1V4, 

•H32P1V4 

•H33P1V4 

♦H34P1V4 

•H35P1V4 

*H36P1V4 

‘H37P1V4 

•H38P1V4 

•H39P1V4 


‘H15P2V1, 

•H16P2V1. 

*H17P2V1. 

•H18P2V1, 

•H19P2V1. 

‘H20P2V1. 

•H21P2V1. 

•H22P2V1, 

•H23P2V1. 

•H24P2V1, 

*H25P2V1, 

•H26P2V1, 

•H27P2V1, 

•H28P2V1, 

•H29P2V1, 

‘H30P2V1, 

•H31P2V1, 

•H32P2V1, 

•H33P2V1, 

•H34P2V1, 

♦H35P2V1, 

‘H36P2V1, 

*H37P2V1, 

•H38P2V1. 

•H39P2V1, 


•H15P2V2, 

•H16P2V2, 

•H17P2V2, 

•H18P2V2, 

•H19P2V2, 

•H20P2V2, 

•H21P2V2, 

•H22P2V2, 

•H23P2V2, 

•H24P2V2. 

♦H25P2V2. 

•H26P2V2, 

•H27P2V2, 

♦H28P2V2, 

♦H29P2V2, 

•H30P2V2, 

•H31P2V2. 

•H32P2V2, 

•H33P2V2, 

•H34P2V2, 

♦H35P2V2. 

•H36P2V2, 

•H37P2V2, 

•H38P2V2, 

•H39P2V2, 


•H15P2V3, 

•H16P2V3, 

•H17P2V3, 

•H18P2V3. 

•H19P2V3, 

•H20P2V3, 

•H21P2V3, 

•H22P2V3, 

•H23P2V3, 

•H24P2V3. 

•H25P2V3, 

•H26P2V3, 

•H27P2V3, 

♦H28P2V3, 

•H29P2V3, 

•H30P2V3, 

•H31P2V3, 

•H32P2V3, 

•H33P2V3, 

•H34P2V3, 

‘H35P2V3, 

•H36P2V3, 

♦H37P2V3, 

•H38P2V3, 

•H39P2V3, 
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*H40P1V1, 

*H40P2V4, 

♦H40P1V2, 

•H40P1V3,  *H40P1V4, 

*H40P2V1, 

*H40P2V2. 

*H40P2V3, 

*H41P1V1, 

•H41P2V4, 

*H41P1V2, 

*H41P1V3,  *H41P1V4, 

*H41P2V1, 

*H41P2V2, 

*H41P2V3, 

*H42P1V1. 

*H42P2V4. 

•H42P1V2, 

*H42P1V3,  *H42P1V4, 

*H42P2V1, 

*H42P2V2, 

*H42P2V3, 

*H43P1V1, 

•H43P2V4, 

*H43P1V2, 

•H43P1V3,  *H43P1V4, 

*H43P2V1, 

‘H43P2V2, 

*H43P2V3, 

*H44P1V1, 

*H44P2V4, 

•H44P1V2, 

*H44P1V3,  *H44P1V4, 

•H44P2V1, 

•H44P2V2, 

*H44P2V3, 

*H45P1V1, 

•H45P2V4, 

*H45P1V2, 

•H45P1V3.  *H45P1V4, 

*H45P2V1, 

*H45P2V2, 

*H45P2V3, 

*H46P1V1, 

*H46P2V4, 

♦H46P1V2, 

•H46P1V3,  *H46P1V4, 

•H46P2V1, 

*H46P2V2, 

*H46P2V3, 

‘H47P1V1, 

*H47P2V4, 

*H47P1V2, 

*H47P1V3,  *H47P1V4, 

*H47P2V1, 

*H47P2V2, 

*H47P2V3, 

*H48P1V1, 

*H48P1V2, 

*H48P1V3,  *H48P1V4, 

*H48P2V1, 

*H48P2V2, 

*H48P2V3, 

•H48P2V4. 

last_v; 

W=add_world( ■5th_floor*, 9) ; 

Hl=add_ph{ •front_hall* , 10,W,1,0); 

HlPl=add_pg(Hl, 0.0, 1, 0)  ; 

HIPIVI  s  add_vertex(HlPl,0.0,0.0) ; 

H1P1V2  =  add_vertex(HlPl, 0.0,239.5) ;  /*nn  506*/ 
HlPlV2a  =  add_vertex(HlPl, -5.3,239.5) ; 

HlPlV2b  =  add_vertex(HlPl, -5.3,203.3) ; 

H1P1V2C  =  add_vertex(HlPl, -244.1,203.3) ; 

HlPlV2d  =  add_vertex(HlPl, -244.1,309.4) ; 

HlPlV2e  =  add_vertex(HlPl,-5.3,309.4); 

HlPlV2f  =  add_vertex(HlPl,-5.3,275.2); 

H1P1V3  =  add_vertex{HlPl, 0.0, 275.2), • 

H1P1V4  =  add_vertex(HlPl, 0.0,713.7) ;  /*nn  510*/ 
HlPlV4a  =  add_vertex(HlPl, -5.3,713.7) ; 

HlPlV4b  =  add_vertex(HlPl, -5.3, 677.5) ; 

H1P1V4C  =  add_vertex{HlPl, -244.1, 677.5) ; 

HlPlV4d  =  add_vertex(HlPl, -244.1,783.6) ; 

HlPlV4e  =  add_vertex(HlPl,-5.3,783.6); 

HlPlV4f  =  add_vertex(HlPl,-5.3,749.4); 

H1P1V5  =  add_vertex(HlPl,0.0,749.4) ; 

H1P1V6  =  add_vertex(HlPl, 0.0,825.9) ;  /*  rm  512*/ 

HlPlV6a  a  add_vertex{HlPl, -5.3, 825.9) ; 

HlPlV6b  a  add_vertex(HlPl,-5.3.789.7); 

H1P1V6C  a  add_vertex(HlPl, -244.1,789.7) ; 

HlPlV6d  a  add_vertex(HlPl,-244.1,895.8); 

HlPlV6e  a  add_vertex(HlPl, -5.3, 895.8) ; 

HlPlV6f  a  add_vertex(HlPl,-5.3,861.6); 

H1P1V7  a  add_vertex (HlPl, 0.0,861.6); 
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H1P1V8  »  adcL.v«rt«x(HlPl, 0.0.937.5) ;  /•  nn  514*/ 

HlPlVSa  «  add^v*rt«x(HlPl, -5.3,937.5); 

HlPlVSb  >  add_v«rtax(HlPl,-5.3.901.3); 

H1P1V8C  >  addLvartax (HlPl, -244.1, 901.3) ; 

HlPlV8d  «  add_v«rtex (HlPl, -244. 1,1007. 4); 

HlPlV8e  *  add_v*rtex(HlPl, -5.3, 1007.4); 

HlPlV8f  >  add_v*rtax(HlPl,-5.3.973.2); 

H1P1V9  «  add_v«rt€X (HlPl, 0.0, 973.2) ; 

HIPIVIO  X  add_v«rtax(HlPl, 0.0. 1049.7);  /*  xm  516  */ 

HlPlVlOa  X  add_vart«x(HlPl, -5.3, 1049.7); 

HlPlVlOb  X  add_v«rtex (HlPl. -5.3,1013.5); 

HlPlVlOc  X  ad<^vertax(HlPl. -244.1, 1013.5); 

HlPlVlOd  X  add_vart«x(HlPl, -244.1. 1119.6); 

HlPlVlOe  X  add_vart«x(HlPl. -5.3, 1119.6) ; 

HlPlVlOf  X  add_vart«x(HlPl. -5.3, 1085.4); 

HlPlVll  X  add_vertex(HlPl, 0.0, 1085.4); 

H1P1V12=  add_vertex(HlPl, 0.0, 1161.7) ;  /*  rm  518  */ 

HlPlV12a  «  add_vertex(HlPl, -5.3, 1161.7); 

HlPlV12b  X  add_vert*x(HlPl. -5.3, 1125.5); 

H1P1V12C  X  add_vertex(HlPl. -244.1, 1125.5) ; 

HlPlV12d  X  add_vertex(HlPl. -244.1, 1231.6); 

H1P1V12«  X  add_vertex(HlPl,-5.3.1231.6); 

HlPlV12f  X  add_vertex(HlPl, -5.3, 1197.4) ; 

H1P1V13  X  add_vertex(HlPl,0.0,1197.4) ; 

H1P1V14  X  add_vertex(HlPl, 0.0, 1273.4);  /*  rm  520  */ 

HlPlV14a  X  add_vertex(HlPl, -5.3, 1273.4); 

HlPlV14b  X  add_vertex(HlPl, -5.3, 1237.2); 

H1P1V14C  X  add_vertex(HlPl, -244.1, 1237.2); 

HlPlV14d  X  add_vertex(HlPl, -244.1, 1343.3); 

HlPlV14e  X  add_vertex (HlPl, -5.3, 1343.3) ; 

HlPlV14f  X  add_vertex(HlPl, -5.3, 1309.1) ; 

H1P1V15  X  add_vertex(HlPl, 0.0, 1309.1); 

H1P1V16  X  add_vertex(Hl’'-' ,0.0,1429.6) ;  /*  rm  522R  */ 

HlPlV16a  X  add_vertex(Hlii, -5.3, 1429.6)  ; 

HlPlV16b  X  add_vertex(HlPl, -5.3, 1393.4); 

H1P1V16C  X  add_vertex(HlPl, -244. 1,1393. 4)  ; 

HlPlV16d  X  add_vertex (HlPl, -244. 1,1499. 5); 

HlPlV16e  X  add_vertex(HlPl, -5.3, 1499.5) ; 

HlPlV16f  X  add_vertex(HlPl, -5.3,1461.3); 

H1P1V17  X  add_vertex(HlPl, 0.0, 1461.3) ; 

H1P1V18  X  add_vertex(HlPl, 0.0, 1488.0);  /•  FD  #1  */ 

HlPlV18a  X  add_v*rtex(HlPl, -5.5, 1488.0); 

HlPlV18b  X  add_vertex(HlPl, -5.5, 1486.0) ; 

H1P1V18C  X  add_vertex(HlPl, -50.0, 1486.0) ; 

HlPlVlSd  X  add_vartex(HlPl, -50.0, 1562.0); 

HlPlVlSe  X  add_vertex (HlPl, -5.5,1562.0); 
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HlPlVlSf  .  ad4_v*rt«x(HlPl, -5.5.1560.0); 


H1P1V19  =  ad<J_v«rt«x(HlPl.  0.0, 1560.0); 

H1P1V20  =  add_vartex(HlPl, 0.0, 1583.3) ;  /*  tin  524  */ 

HlPlV20a  =  adcL.vartex(HlPl, -5.3, 1583.3); 

HlPlV20b  =  add^vartax(HlPl.-5.3,1547.1); 

H1P1V20C  s  add_vertax(HlPl, -244.1, 1547.1) ; 

HlPlV20d  s  add_vartax(HlPl. -244.1. 1653.2) ; 

HlPlV20e  *  add_vartax{HlPl, -5.3,1653.2) ; 

HlPlV20f  =  ad«i_vertex(HlPl, -5.3.1619.0) ; 

H1P1V21  =  ad«i_vartax(HlPl,0.0.1619.0)  ; 

H1P1V22  *  add_vartex(HlPl. 0.0, 1650.4);  /*  water  cooler  */ 

HlPlV22a  .  add_vertex(HlPl, -30.0, 1650.4) ; 

HlPlV22b  *  adcLvertex(HlPl. -30.0, 1684.5); 

H1P1V23  =  add_vertex{HlPl, 0.0, 1684.5) ; 

H1P1V24  =  add_vertex(HlPl. 0.0, 1754.5) ;  /*  rm  526R  */ 

HlPlV24a  =  add_vertex(HlPl, -5.3. 1754.5); 

HlPlV24b  =  add_vertex(HlPl. -5.3, 1718.3) ; 

H1P1V24C  =  add_vertex(HlPl, -244.1, 1718.3) ; 

HlPlV24d  =  add_vertex(HlPl. -244.1. 1790.0) ; 

HlPlV24e  =  add_vertex(HlPl, -5.3, 1790.0) ; 

HlPlV24f  =  add_vertex(HlPl, -5.3, 1786.2) ; 

H1P1V25  =  add_vertex(HlPl, 0.0, 1786.2) ; 

H1P1V26  =  add_vertex(HlPl, 0.0, 1836.4) ;  /*  rm  528A  */ 

HlPlV26a  =  add_vertex(HlPl, -5.3,1836.4) ; 

HlPlV26b  =  add_vertex(HlPl, -5.3, 1800.2) ; 

H1P1V26C  *  add_vertexlHlPl,-244.1, 1800.2) ; 

HlPlV26d  =  add_vertex(HlPl, -244.1, 1875.0) ; 

HlPlV26e  =  add_vertex(HlPl, -5.3, 1875.0) ; 

HlPlV26f  =  add_vertex(HlPl, -5.3, 1872.1) ; 

H1P1V27  =  add_vertex(HlPl, 0.0, 1872.1) ; 

H1P1V28  =  add_vertex(HlPl, 0.0, 1919.1);  /*  rm  528B  */ 

HlPlV28a  =  add_vertex(HlPl, -5.3, 1919. 1) ; 

HlPlV28b  =  add_vertex(HlPl, -5.3, 1882.9); 

H1P1V28C  =  add_vertex(HlPl, -244.1, 1882.9); 

HlPlV28d  =  add_vertex(HlPl, -244.1, 1989.0) ; 

HlPlV28e  =  add_vertex(HlPl,-5.3,1989.0) ; 

HlPlV28f  =  add_vertex(HlPl, -5.3,1954.8); 

H1P1V29  =  add_vertex(HlPl, 0.0, 1954.8)  ; 

H1P1V30  =  adcLvertex(HlPl,0.0,2030.4) ;  /*  rm  530A  */ 

HlPlV30a  =  add_vertex(HlPl, -5.3,2030.4) ; 

HlPlV30b  =  ad(i_vertex(HlPl, -5.3, 1994.2); 

H1P1V30C  =  add_vertex{HlPl, -244.1, 1994.2) ; 

HlPlV30d  =  ad4_vertex(HlPl, -244.1,2100.3); 

HlPlV30e  s  add_vertex(HlPl, -5.3,2100.3) ; 

HlPlV30f  =  add_vertex(HlPl, -5.3,2066.1); 
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H1P1V31  .  ad4_v*rt«x(HlPl, 0.0,2066.1); 

H1P1V32  «  add_v*rt«x(HlPl. 0.0, 2195.1);  /*  rm  530B  */ 

HlPlV32a  «  add_vertax(HlPl, -5.3,2195.1); 

HlPlV32b  »  add_vartex(HlPl, -5.3,2158.8) ; 

H1P1V32C  =  add_vertex{HlPl, -244.1,2158,8); 

HlPlV32d  »  addLv«rtax(HlPl, -244.1,2250.0); 

HlPlV32e  =  add_vartax(HlPl. -5.3,2250,0) ; 

HlPlV32f  =  add_v«rtax(HlPl, -5.3,2230.8); 

H1P1V33  *  ad;L.vertex(HlPl, 0.0,2230.8) ; 

H1P1V34  »  add_v«rtex(HlPl, 0.0,2253,8);  /*  rm  530C  */ 

HlPlV34a  =  add_vert«x(HlPl, -5.3,2253.8) ; 

HlPlV34b  s  add_vartax(HlPl, -5.3,2251.0); 

H1P1V34C  =  add_vert«x(HlPl, -244.1,2251.0); 

HlPlV34d  =  add_v«rtex(HlPl, -244.1,2350.0); 

HlPlV34e  *  add_v«rt«x(HlPl, -5.3,2350.0) ; 

HlPlV34f  =  add_vertax(HlPl, -5.3,2289.5); 

H1P1V35  =  add_vertex(HlPl, 0.0, 2289.5) ; 

H1P1V36  =  add_vertex(HlPl, 0.0,2351.2); 

H1P1V37  ::  add_vertex(HlPl,  98.0,2351.2); 

H1P1V38  =  add_vertex(HlFl, 98.0, 2171.9) ;  /*  rm  421  */ 

HlPlV38a  =  add_v«rt«x(HlPl, 103.3,2171.9); 

HlPlV38b  =  add_vertex(HlPl, 103.3,2206.6); 

H1P1V38C  «  add_vert*x(HlPl, 342.1,2206.6) ; 

HlPlV38d  =  add_vertex(HlPl, 342.1,2099.5) ; 

HlPlV38e  r  add_vertex(HlPl, 103.3,2099.5); 

H1P1V38£  »  add_vertex(HlPl, 103.3,2136.2) ; 

H1P1V39  .  add_vertex(HlPl, 98.0,2136.2); 

H1P1V40  =  add_vertex(HlPl, 98.0, 1937.7) ;  /*  rm  531  */ 

HlPlV40a  =  add_vertex(HlPl, 103.3, 1937.7); 

HlPlV40b  =  add_vertex(HlPl, 103.3, 1972.7); 

H1P1V40C  a  add_vertex(HlPl, 342.1, 1972.7); 

HlPlV40d  =  add_vertex(HlPl, 342.1, 1865.6) ; 

HlPlV40e  a  add_vertex(HlPl, 103.3, 1865.6)  ; 

HlPlV40f  a  add_vertex(HlPl, 103.3,1877.7) ; 

H1P1V41  a  add_vertex(HlPl,98.0, 1877,7) ; 

H1P1V42  a  add_vertex(HlPl, 98.0, 1744.5);  /*  rm  529  */ 

HlPlV42a  a  add_vert«x(HlPl,103.3,1744.5) ; 

HlPlV42b  a  add_vertex(HlPl,103.3,1779.5) ; 

H1P1V42C  a  add_vertex(HlPl, 342.1, 1779.5); 

HlPlV42d  a  add_vertex(HlPl, 342.1, 1672.4) ; 

HlPlV42e  a  add_vert«x{HlPl, 103.3, 1672.4); 

HlPlV42f  a  add_vertex(HlPl, 103.3, 1684.5) ; 

H1P1V43  a  add_vertex(HlPl, 98,0, 1684.5) ; 

H1P1V44  a  add_vertex(HlPl, 98.0, 1522.4) ;  /*  rm  527  */ 

HlPlV44a  a  add_vertex{HlPl,103.3,1522.4) ; 

HlPlV44b  a  add_vertex{HlPl,103,3,1557.4) ; 
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H1P1V44C  *  add_v«rt*x(HlPl. 342.1. 1557.4) ; 
HlPlV44d  *  add_v«rt«x (HlPl, 342.1, 1450.3) ; 
HlPlV44a  «  add_vartax(HlPl,103.3.1450.3); 
HlPlV44f  »  add_vartax(HlPl,103.3.1462.4); 

H1P1V45  *  add_vartax(HlP1.98.0,1462.4); 
H1P1V46  =  add_vartax(HlP1.98.0,1342.7) ; 
HlPlV46a  «  add_vartax(HlP1.103.3,1342.7) ; 
HlPlV46b  *  add_vertax(HlPl. 103.3. 1377.7); 
H1P1V46C  a  add_vartax(HlPl,342.1,1377.7); 
HlPlV46d  *  add_vartax(HlPl,342.1,1270.6); 
HlPlV46a  a  add_vartax(HlPl,103.3,1270.6); 
HlPlV46f  a  add_vertax{HlPl,103.3,1307.0); 

H1P1V47  s  add_vertax(HlPl. 98.0, 1307.0) ; 
H1P1V48  a  add_vartax(HlPl,98.0,1118.8) ; 
HlPlV48a  a  add_vartax(HlPl,103.3.1118.8) ; 
HlPlV48b  a  add_vertax(HlPl. 103.3, 1153.8) ; 
H1P1V48C  a  add_vertax(HlPl. 342.1, 1153.8) ; 
HlPlV48d  a  add_vartax(HlPl,342.1,1046.7) ; 
H1P1V48«  a  add_vertax(HlPl, 103. 3, 1046.7) ; 
HlPlV48f  a  add_vertax(HlPl. 103. 3, 1083.1 ); 

H1P1V49  a  add_vert«x(HlPl, 98.0, 1083.1) ; 
H1P1V50  a  add_vert®x(HlPl, 98.0,796.1) ;  / 

HlPlVSOa  a  add_vertex(HlPl, 103.3, 796. 1) ; 
HlPlVSOb  a  add_vertex(HlPl,103.3,831.1); 
HlPlVSOc  a  add_vertax(HlPl, 342.1, 831. 1) ; 
HlPlVSOd  a  add_vertex{HlPl, 342.1,724.0) ; 
HlPlVSOe  a  add_v«rtex(HlPl, 103.3,724.0) ; 
HlPlVSOf  a  add_vertex(HlPl,103.3.760.4); 

H1P1V51  a  add_vertex(HlPl,98.0,760.4); 
H1P1V52  a  add_vertex(HlPl, 98.0, 564.5) ;  / 

HlPlV52a  a  add_vertex(HlPl,103.3,564.5) 
HlPlV52b  a  add_vertex(HlPl,103.3,599.5) 
H1P1V52C  a  add_vertex(HlP1.342.1,599.5) 
HlPlV52d  a  add_vertex(HlP1.342.1,492.4) 
HlPlV52e  a  add_vertex(HlPl,103.3,492.4) 
HlPlV52f  a  add_vertex(HlPl, 103.3, 528.8) 

H1P1V53  a  add_vert«x(HlPl,9».0,528.8); 
H1P1V54  a  add_vert«x(HlPl,98.0,413.9); 
H1P1V55  a  add_v«rtex(HlPl,257.9,413.9) ; 
HlPlV55a  a  add_vertex{HlPl,257.9,419.2) 
HlPlV55b  a  add_vertex(HlPl,221.7,419.2) 
H1P1V55C  a  add_vertex(HlPl,221.7,500.0) 
HlPlV55d  a  add_v®rt«x(HlPl, 300. 0,500.0) 
H1P1V55®  a  add_vert«x{HlPl, 300.0, 419.2) 
HlPlV55f  a  add_vertex(HlPl,293.9,419.2) 


/*  rm  525  •/ 


/*  rm  523  */ 


*  rm  521  */ 


•  rm  519  */ 


/•  corners  */ 
/*  rro  ?  •/ 
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H1P1V56  .  adcLv«rt«x(HlP1.293.9,413.9) ; 

H1P1V57  s  add_v«rt«x(HlP1.337.5.413.9) ; 

H1P1V58  =  add_vartax(HlP1.337.5.402.6) ;  /*  office  */ 

HlPlVBSa  *  add_vertax(HlPl, 342.8, 402.6) ; 

HlPlV58b  =  add_vartax(HlPl,342.8.600.0) ; 

H1P1V58C  =  add_vartax(HlP1.449.9.600.0)  ; 

HlPlV58d  *  add_vartax(HlP1.449.9.330.0)  ; 

HlPlV58a  «  add_vartax(HlP1.342.8.330.0) ; 

HlPlV58f  =  adcLvartax(HlPl,342.8,342.6); 

H1P1V59  »  ad<L.vartax(HlPl,337.5.342.6) ; 

H1P1V60  *  add_vertax(HlPl. 337.5, 310.2);  /*  rm  511  */ 

HlPlV60a  .  add_vertax(HlP1.342.8.310.2) ; 

HlPlveOb  =  add_vartex{HlPl. 342.8, 315.0); 

H1P1V60C  s  add_vartax(HlPl,449.9,315.0) ; 

HlPlveOd  *  add_vartax(HlP1.449.9.0.0)  ; 

HlPlveOa  =  add_vartax(HlP1.342.8.0.0)  ; 

HlPlV60f  *  add_vartax(HlPl,342.8.274.5); 

H1P1V61  =  add_vertex(HlPl. 337.5,274.5) ; 

H1P1V62  s  add^vartax(HlPl,337.5,267.4); 

H1P1V63  *  add_vartex(HlPl, 306.9,267.4);  /*  elev  1  (left)*/ 

HlPlV63a  =  adcLvertex(HlPl, 306.9, 267.7) ; 

HlPlV63b  =  add_vertex(HlPl,303.9,267.7) ; 

H1P1V63C  *  add_vertex(HlPl,303.9,255.7) ; 

HlPlV63d  =  add_vertex(HlPl,277.9,255.7) ; 

HlPlV63e  =  add_vertex(HlPl,251.9,255.7); 

HlPlV63f  s  adcLvertex(HlPl,251.9,267.7); 

HlPlV63g  »  add_vertex(HlPl, 248.9, 267.7); 

H1P1V64  =  add_vertex{HlPl,248.9,267.4) ; 

H1P1V65  =  add_vertex(HlPl, 192.2,267.4); 


HlPlV65a  *  add_vertex(HlPl,192.2,267.7) ; 

HlPlV65b  =  add_vertex(HlPl, 189.2,267.7); 

H1P1V65C  =  add_vertex(HlPl, 189.2,255.7) ; 

HlPlV65d  s  add_vertex(HlPl, 163.2,255.7); 

HlPlV65e  *  add_vertex(HlPl,137.2,255.7) ; 

HlPlV65f  =  add_vertex(HlPl, 137.2,267.7) ; 

H1P1V650  =  add_vertex(HlPl, 134.2,267.7) ; 

H1P1V66  s  add_vertex(HlPl, 134.2,267.4) ; 

H1P1V67  .  add_vertex(HlPl,98.0,267.4); 

H1P1V68  s  add_vertex(HlPl, 98.0, 100.0) ;  /*  stairwell  */ 

HlPlV68a  »  add_vertex(HlPl, 103.3, 100.0); 

HlPlV68b  *  add_vertexlHlPl, 103.3, 125.0) ; 

H1P1V68C  =  add_vertex(HlPl, 150.0, 125.0) ; 

HlPlV68d  =  add_vertex(HlPl, 150.0,40.0)  ; 

HlPlV68e  s  adcLvertexCHlPl, 103.3,40.0) ; 

HlPlV68f  *  add_vertex(HlPl, 103.3,64.3); 
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H1P1V69  >  add_v«rt«x(HlPl, 98.0. 64.3) ; 

H1P1V70  «  add_vert«x(HlPl,98.0.0.0); 

HlP2sadd_pg(Hl, 102 .0, 0. 1) ;  /*inain  calling*/ 

H1P2V1  =  add_vartax(HlP2,0.0,0.0); 

H1P2V2  »  add_vartax(HlP2.0.0.2351.2) ; 

H1P2V3  .  add_vartax(HlP2,98.0,2351.2) ; 

H1P2V4  <  add_vartax(HlP2.98.0.0.0); 

HlP3sadd_j>g(Hl, 113.3, 0, 1) ;  /•elev  calling*/ 

H1P3V1  »  add_vartax(HlP3, 98.0, 267.4) ; 

H1P3V2  B  add_vartax (H1P3. 98.0, 413.9) ; 

H1P3V3  =  add_vartax(HlP3,337.5,413.9) ; 

H1P3V4  =  add_vartax(HlP3,337.5.267.4); 

H1P4  »  add_pg (HI, 84 . 0, 0, 1) ;  /*nn  506  door  jam  calling*/ 
H1P4V1=  add_vartax(HlP4. 0.0,239.5) ; 

H1P4V2»  ad<l_vartax(HlP4. -5.3,239.5) ; 

H1P4V3=  add_vartax(HlP4. -5.3,275.2)  ; 

H1P4V4=  add_vartax(HlP4, 0.0,275.2) ; 

H1P5  a  add_pg (HI, 84 . 0, 0, 1) ;  /*rm  510  door  jam  ceiling*/ 
H1P5V1=  add_vartax(HlP5, 0.0,713.7) ; 

HlP5V2a  add_vartax(HlP5, -5.3,713.7) ; 

H1P5V3=  add_vartax(HlP5, -5.3,749.4) ; 

HlP5V4a  add_vartax(HlP5, 0.0,749.4) ; 

H1P6  a  add_pg(Hl, 84 .0, 0, 1) ;  /*rm  512  door  jam  ceiling*/ 
HlPevia  add_vertex(HlP6, 0.0,825.9) ; 

HlP6V2a  add_vertex (H1P6 ,-5.3,825.9); 

HlP6V3a  add_vartex(HlP6,-5.3,861.6) ; 

H1P6V4=  add_vertex(HlP6, 0.0,861.6) ; 

H1P7  a  add_pg(Hl, 84.0, 0, 1) ;  /*rm  514  door  jeun  ceiling*/ 
H1P7V1=  add_vertex (H1P7 ,0.0,937.5); 

HlP7V2a  add_vertex(HlP7,-5.3,937.5) ; 

HlP7V3a  add_vertex(HlP7 ,-5.3,973.2); 

HlP7V4a  add_vertex(HlP7,0.0,973.2) ; 

H1P8  a  add_pg(Hl, 84 .0, 0, 1) ;  /*rm  516  door  jam  ceiling*/ 
HlPSVla  add.vertex (H1P8 ,0.0, 1049 .7 ) ; 

HlP8V2a  add_vertex(HlP8, -5.3, 1049.7) ; 

H1P8V3=  add_vertex(HlP8, -5.3,1085.4) ; 

HlP8V4a  add_vertex(HlP8, 0.0, 1085.4) ; 

H1P9  a  add_pg(Hl, 84.0, 0, 1) ;  /*rm  518  door  jam  ceiling*/ 
HlP9Vla  add_vertex(HlP9, 0.0, 1161.7) ; 

HlP9V2a  add_vartax (H1P9 ,-5.3,1161.7); 

HlP9V3a  addLvartex(HlP9, -5.3, 1197.4); 

HlP9V4a  add_vartax(HlP9, 0.0, 1197.4) ; 

HIPIO  a  add_pg(Hl,84.0,0, 1) ;  /*rm  520  door  jam  ceiling*/ 
HlPlOVla  add_vertax(HlP10, 0.0, 1273.4) ; 

HlP10V2a  add_vertax(HlP10, -5.3,1273.4); 

HlP10V3a  add_vertex(HlP10,  -5.3,1309.1); 

HlP10V4a  add_vertex (HlPlO, 0 .0,1309 . 1) ; 

HlPll  a  add_pg(Hl, 84.0, 0, 1) ;  /*rro  522R  door  jam  ceiling*/ 


HlPllVl.  ad«|_v«rt*x(HlPll.  0.0, 1429.6)  ; 

H1P11V2.  add_v«rt*x(HlPll. -5.3, 1429.6); 

H1P11V3.  add_vartax(HlPll.-5.3. 1461.3) ; 

H1P11V4.  add_vartax(HlPll,0.0.1461.3) ; 

H1P12  «  add_pg (HI. 84 .0. 0, 1) ;  /*nn  FD  1  door  jam  ceiling*/ 
H1P12V1S  add_vertex(HlP12, 0.0,1488.0) ; 

H1P12V2«  add_vertex(HlP12, -5.5, 1488.0) ; 

H1P12V3*  add_vertex(HlP12, -5.5, 1560.0) ; 

H1P12V4»  add_vertex(HlP12. 0.0,1560.0); 

H1P13  s  add_pg (HI, 84 .0, 0, 1) ;  /*nn  524  door  jam  ceiling*/ 
H1P13V1.  add_vertex (H1P13 ,0.0, 1583 . 3 ) ; 

H1P13V2«  addLvertex (H1P13 ,-5.3.1583.3); 

H1P13V3*  add_vertex(HlP13. -5.3, 1619.0); 

H1P13V4=  addLvertex(HlP13, 0.0, 1619.0) ; 

H1P14  *  add_pg(Hl,84.0.0,l) ;  /•  526R  ceiling*/ 

H1P14V1«  add_vertex(HlP14, 0.0, 1754.5) ; 

H1P14V2*  ad<l_vertex(HlP14,  -5.3, 1754.5)  ; 

H1P14V3=  add_vertex(HlP14, -5.3,1786.2) ; 

H1P14V4=  add_vertex(HlP14, 0.0, 1786.2) ; 

H1P15  »  add_pg(Hl, 84 .0, 0, 1) ;  /*rni  528A  door  jam  ceiling*/ 
H1P15V1=  add_vertex(HlP15,0.0, 1836.4)  ; 

H1P15V2*  add_vertex(HlP15. -5.3, 1836.4) ; 

H1P15V3=  add_vertex (H1P15, -5.3, 1872 . 1 ) ; 

H1P15V4*  add_vertex (H1P15, 0 .0, 1872 . 1 ) ; 

H1P16  a  add_pg (HI, 84 .0 , 0, 1) ;  /*nn  528B  door  jam  ceiling*/ 
HlPievix  add_vertex(HlP16, 0.0, 1919.1) ; 

H1P16V2*  add_vertex(HlP16, -5.3,1919.1) ; 

H1P16V3*  adcLvertex(HlP16, -5.3, 1954.8) ; 

H1P16V4S  add_vertex(HlP16, 0.0, 1954.8) ; 

H1P17  =  adcLpg (HI, 84 .0, 0, 1) ;  /*nn  530A  door  jeun  ceiling*/ 
H1P17V1X  add_vertex(HlP17, 0.0, 2030.4) ; 

H1P17V2=  add_vertex(HlP17, -5.3,2030.4) ; 

H1P17V3X  add_vertex(HlP17, -5.3,2066.1) ; 

H1P17V4=  add_vertex{HlPl7, 0.0,2066.1) ; 

H1P18  =  add_pg(Hl, 84 .0, 0, 1) ;  /*nn  530B  door  jam  ceiling*/ 
HlPlSVlx  add_vertex{HlP18, 0.0,2195.1) ; 

H1P18V2X  add_vertex(HlP18, -5.3,2195.1) ; 

H1P18V3S  adcLvertex(HlP18, -5.3,2230.8)  ; 

H1P18V4X  add_vertex(HlP18, 0.0,2230.8) ; 

H1P19  a  add_pg(Hl, 84 . 0, 0, 1) ;  /*rro  530C  door  jam  ceiling*/ 
HlP19Vla  add_vertex(HlP19, 0.0,2253.8) ; 

HlP19V2a  add_vertex(HlP19, -5.3,2253.8) ; 

H1P19V3«  add_vertex(HlP19, -5.3,2289.5) ; 

HlP19V4a  add_vertex(HlP19, 0.0.2289.5) ; 

H1P20  a  add_pg (HI, 84 . 0, 0, 1) ;  /*rm  421  door  jam  ceiling*/ 
HlP20Vla  add_vertex(HlP20, 98.0,2171.9) ; 

HlP20V2a  add_vertex(HlP20, 103.3,2171.9) ; 

HlP20V3a  add_vertex(HlP20,103.3,2136.2) ; 

H1P20V4=  add_vertex(HlP20, 98.0,2136.2) ; 

H1P21  a  add_pg (HI, 84 . 0, 0, 1) ;  /*m  531  door  jam  ceiling*/ 

HlP21Vla  add_vertex(HlP21,98,0,1937.7) ; 
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H1P21V2*  ad4_v«rt«x(HlP21, 103.3,1937.7) ; 

H1P21V3*  add_v«rt«x(HlP21, 103.3, 1877.7) ; 

H1P21V4*  add_vartax(HlP21,98.0,1877.7) ; 

H1P22  *  add_pg(Hl, 84.0, 0, 1) ;  /*xm  529  door  jam  ceiling*/ 
H1P22V1.  ad4_vertex(HlP22, 98.0, 1744.5) ; 

H1P22V2.  add_vertex(HlP22, 103.3.1744.5) ; 

H1P22V3S  add_vertex(HlP22, 103.3, 1684.5) ; 

H1P22V4S  add_vertcx(HlP22, 98.0, 1684.5) ; 

H1P23  »  add_pg(Hl, 84.0, 0, 1) ;  /*rm  527  door  jam  ceiling*/ 
H1P23V1«  adcLvertex(HlP23, 98.0, 1522.4)  ; 

H1P23V2-  add_vertex (H1P23 , 103.3, 1522 . 4 ) ; 

H1P23V3.  add_vertex {H1P23 .103.3, 1462 . 4 ) ; 

H1P23V4=  add_vertex(HlP23. 98.0, 1462.4) ; 

H1P24  s  add_pg (HI,  84 . 0, 0. 1)  ,*  /*rm  525  door  jam  ceiling*/ 
H1P24V1=  add_vertex(HlP24. 98.0, 1342.7) ; 

H1P24V2*  add_vertex(HlP24. 103.3, 1342.7) ; 

H1P24V3=  add_vertex(HlP24. 103. 0,1307.0) ; 

H1P24V4S  add_vertex(HlP24, 98.0. 1307.0) ; 

H1P25  *  add_P9(Hl, 84.0, 0, 1) ;  /*rm  523  door  jam  ceiling*/ 
H1P25V1*  add_vertex(HlP25. 98.0, 1118.8) ; 

H1P25V2=  add_vertex(HlP25.103.3,1118.8) ; 

H1P25V3*  add_vertex(HlP25, 103. 3, 1083.1) ; 

H1P25V4=  add_vertex{HlP25. 98.0, 1083.1) ; 

H1P26  s  add_pg(Hl, 84.0, 0, 1) ;  /*rm  521  door  jam  ceiling*/ 
H1P26V1*:  add_vertex(HlP26. 98. 0,796.1)  ; 

H1P26V2=  add_vertex(HlP26, 103.3,796.1) ; 

H1P26V3=  add_vertex(HlP26,103.3,760.4) ; 

H1P26V4S  add_vertex(HlP26,98.0.760.4); 

H1P27  «  add_pg(Hl, 84 .0, 0, 1) ;  /*rm  519  door  jam  ceiling*/ 
H1P27V1*  add_vertex (H1P27 ,98.0,564.5); 

H1P27V2=  add_vertex(HlP27, 103.3,564.5) ; 

H1P27V3=  add_vertex{HlP27,103.3,528.8) ; 

H1P27V4=  add_vertex(HlP27, 98.0,  528.8) ; 

H1P28  =  add_pg(Hl,84.0, 0. 1) ;  /*rm  ?  door  jam  ceiling*/ 
H1P28V1=  add_vertex(HlP28,257.9,413.9) ; 

H1P28V2=  add_vertex(HlP28,257.9,419.2) ; 

H1P28V3=  add_vertex(HlP28,293.9.419.2) ; 

H1P28V4=  add_vertex(HlP28,293.9,413.9)  ; 

H1P29  =  add_pg (HI, 84 . 0, 0, 1) ;  /*  office  door  jam  ceiling*/ 

H1P29V1=  add_vertex(HlP29, 337.5, 402.6) ; 

H1P29V2=  add_vertex(HlP29, 342.8, 402.6); 

H1P29V3=  adcLvertex(HlP29,342.8.342.6) ; 

H1P29V4=  add_vertex(HlP29,337.5,342.6) ; 

H1P30  «  add_pg(Hl, 84.0, 0, 1) ;  /•  rm  511  door  jam  ceiling*/ 

H1P30V1.  add_vertex(HlP30,337.5,310.2) ; 

H1P30V2S  add_vertex(HlP30, 342.8, 310.2)  ; 

H1P30V3*  add_vertex(HlP30, 342.8,274.5); 

H1P30V4*  ad<l_vertex(HlP30,337.5,274.5); 

H1P31  =  add_;,.g(Hl,  83 .8,  0, 1) ;  /*  elev  1  door  jam  ceiling*/ 

H1P31V1»  add_vertex(HlP31, 303.9,267.7); 
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H1P31V2*  add_v«rt«x(HlP31. 303.9,255.7) ; 

H1P31V3=  add_v«rt*x(HlP31.277.9,255.7) ; 

H1P31V4.  add_vartax(HlP31.25l.9,255.7) ; 

H1P31V5.  add_vertax(HlP31.251.9,267.7) ; 

H1P32  *  add_P9(Hl, 83 .8, 0, 1) ;  /*  alev  2  door  jam  ceiling*/ 

H1P32V1=  add_vertex{HlP32,189.2.267.7) ; 

H1P32V2*  add_vertex (H1P32 . 189,2.255.7) ; 

H1P32V3*  add_vertex{HlP32. 163.2,255.7) ; 

H1P32V4»  add_vertex (H1P32 ,137.2,255.7); 

H1P32V5.  add_vertex(HlP32,137.2,267.7) ; 

H1P63  =  add_pg(H1.86.8.0,l) ;  /*  elev  1  ceiling*/ 

H1P63V1S  add_vertex(HlP63, 306.9,267.4) ; 

H1P63V2S  add_vertex(HlP63. 306.9,267.7) ; 

H1P63V3=  add_vertex(HlP63,248.9,267.7) ; 

H1P63V4*  add_vertex(HlP63,248.9,267.4) ; 


H1P64  =  add_pg(Hl, 86.8, 0, 1) ;  /*  elev  2  ceiling*/ 

H1P64V1S  add_vertex(HlP64, 192.2,267.4) ; 

HlP64V2a  add_vertex(HlP64, 192.2,267.7) ; 

H1P64V3S  add_vertex(HlP64,134.2,267.7); 

H1P64V4=  add_vertex(HlP64, 134.2,267 ,4) ; 

H1P33  =  add_pg(Hl, 84 . 0, 0, 1 ) ;  /*  stairwell  doer  jam  ceiling*/ 

H1P33V1*  add_vertex(HlP33, 98.0, 100.0)  ; 

H1P33V2=  add_vertex(HlP33, 103.3,100.0) ; 

HlP33V3a  add_vertex(HlP33,103.3,64.3) ; 

H1P33V4S  add_vertex (H1P33 , 98 . 0, 64 . 3 ) ; 

H1P34  =  add_pg{Hl, 144.0, 0, 1) ;  /*rm  506  ceiling*/ 

H1P34V1=  add_vertex{HlP34, -5.3,203,3) ; 

H1P34V2S  add_vertex(HlP34, -244.1,203.3) ; 

H1P34V3=  add_vertex(HlP34, -244.1,309.4) ; 

H1P34V4=  add_vertex(HlP34,  -5.3,30i».4)  ; 

H1P35  =  add_pg(Hl, 144.0, 0, 1) ;  /*rm  510  ceiling*/ 

H1P35V1=  add_vertex(HlP35, -5 .3 , 677 .5) ; 

H1P35V2=  add_vertex(HlP35, -244.1,677.5) ; 

H1P35V3=  add_vertex (H1P35 , -244 .1,783.6); 

H1P35V4=  add_vertex(HlP35,-5.3,783.6) ; 

H1P36  *  add_pg(Hl, 144,0, 0, 1) ;  /*rm  512  ceiling*/ 

H1P36V1=  add_vertex(HlP36, -5.3,789.7) ; 

H1P36V2=  add_vertex(HlP36,-244.1,789.7) ; 

H1P36V3=  add_vertex(HlP36, -244.1,895.8) ; 

H1P36V4=  add_vertex(HlP36, -5,3,895.8) ; 

H1P37  a  add_pg(Hl, 144.0, 0, 1) ;  /*rm  514  ceiling*/ 

H1P37V1=  add_vertex(HlP37, -5.3,901.3) ; 

HlP37V2a  add_verex(HlP37, -244.1,901.3) ; 

H1P37V3=  add_vertex(HlP37, -244. 1,1007. 4) ; 

H1P37V4S  adcLvertex (H1P37 ,-5.3,1007.4); 

H1P38  a  add_pg(Hl, 144,0, 0, 1) ;  /*rm  516  ceiling*/ 


61 


H1P38V1.  <»id_^^«rt«x(HlP38. -5.3. 1013.5)  ; 

H1P38V2S  ad4_v*rt«x(HlP38, -244.1. 1013.5) ; 

H1P38V3X  add_v«rt«x(HlP38. -244.1.1119.6)  ; 

H1P38V4«  add_v«rt«x (H1P38. -5.3. 1119 . 6)  ; 

H1P39  *  add_psr(Hl.  144.0,  0.1);  /‘nn  518  ceiling*/ 

H1P39V1.  add_vart«x»HlP39. -5.3. 1125.5) ; 

H1P39V2-  add_vartax(HlP39, -244.1.1125.5) ; 

H1P39V3*  add_vartex(HlP39. -244.1.1231.6) ; 

H1P39V4*  add_vartax(HlP39,-5.3,1231.6) ; 

H1P40  *  add_pg (HI, 144 . 0, 0, 1 ) ;  /•rm  520  ceiling*/ 

H1P40V1*  add_vertex(HlP40. -5.3, 1237.2) ; 

H1P40V2*  add_vertex (H1P40 , -244.1. 1237.2) ; 

H1P40V3X  add_vertex(HlP40. -244.1.1343.3); 

H1P40V4*  add_vertex(KlP40.-5.3,1343.3) ; 

H1P41  X  add_pg(Hl,144  0,0,1);  /*rm  522R  ceiling*/ 
H1P41V1X  add_vertex(HlP41.-5.3.1393.4)  ; 

H1P41V2=  add_vertex(HlP41, -244.1, 1393.4) ; 

H1P41V3X  add_vertex(HlP41. -244.1, 1499.5) ; 

H1P41V4X  add_vertex(HlP41. -5.3, 1499.5) ; 

H1P42  X  add_pg(Hl. 144.0, 0,1);  /•  FDl  ceiling*/ 

H1P42V1=  add_vertex(HlP42. -5.5, 1486.0) ; 

H1P42V2X  add_vertex{HlP42, -50.0, 1486.0) ; 

H1P42V3X  add_vertex(HlP42,  -50.0, 1562.0)  ,- 
H1P42V4X  add_vertex (H1P42 . -5 .5,1562 . 0)  ; 

H1P43  X  add_pg(Hl, 144.0, 0, 1) ;  /•rm  524  ceiling*/ 

H1P43V1X  add_vertex (H1P43 ,-5.3, 1547 . 1 ) ; 

Hl?43V2x  add_vertex (H1P43 ,-244.1,1547.1); 

H1P43V3X  add_vertex(HlP43, -244.1, 1653.2) ; 

H1P43V4X  add_vertex(HlP43. -5.3,1653.2) ; 

H1P44  X  add_pg (HI, 84 .0, 0, 1) ;  /*  water  fountain  ceiling’/ 

H1P44V1=  add_vertex(HlP44, 0.0, 1650.4) ; 

H1P44V2X  add_vertex(HlP44, -30.0, 1650.4)  ; 

H1P44V3X  add_vertex(HlP44,-30.0,1684.5) ; 

H1P44V4X  add_vertex(HlP44, 0.0, 1684.5) ; 

H1P45  X  add_pg(Hl, 144. 0,0,1);  /•rm  526R  ceiling*/ 

H1P45V1X  add_vertex (H1P45 , -5.3,1718.3); 

H1P45V2X  add_vertex(HlP45, -244.1, 1718.3) ; 

H1P45V3X  add_vertex(HlP45, -244.1,1790.0) ; 

H1P45V4=  add_vertex(HlP45,-5.3,1790.0) ; 

H1P46  X  add_pg(Hl, 144.0, 0, 1) ;  /*rra  528A  ceiling*/ 
H1P46V1X  add_vertex(HlP46, -5.3, 1800.2) ; 

H1P46V2X  add_vertex(HlP46, -244 . 1, 1800 .2) ; 

H1P46V3X  add_vertex(HlP46, -244.1, 1875.0) ; 

H1P46V4X  add_vertex (H1P46, -5.3, 1875 . 0) ; 

H1P47  X  add_pg(Hl, 144.0, 0, 1) ;  /•rm  528B  ceiling*/ 
H1P47V1=  add_vertex(HlP47, -5.3, 1882,9) ; 

H1P47V2X  add_vertex(HlP47, -244.1, 1882.9) ; 

H1P47V3X  add_vertex(HlP47, -244. 1,1989.0) ; 

H1P47V4=  add_vertex (H1P47 ,-5.3,1989.0); 

H1P48  X  add_pg(Hl, 144.0, 0, 1) ;  /*rro  530A  ceiling*/ 
H1P48V1X  add_vertex{HlP48, -5,3,1994.2) ; 
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H1P48V2S  add_vertex(HlP48, -244.1,1994.2)  ; 

H1P48V3*  add_vertex(HlP48, -244.1,2100.3)  ; 

H1P48V4=  add_vertex(HlP48. -5.3,2100.3) ; 

H1P49  *  add_pg(Hl, 144.0, 0, 1) ;  /*nn  530B  ceiling*/ 

H1P49V1=  add_vertex(HlP49, -5.3,2158.8) ; 

H1P49V2S  add_vertex(HlP49,  -244.1,2158.8)  ; 

H1P49V3S  add_vertex(HlP49, -244.1,2250.0) ; 

H1P49V4»  add_vertex {H1P49 ,-5.3,2250.0); 

H1P50  =  add_pg(Hl, 144.0, 0, 1) ;  /‘rm  530C  ceiling*/ 

HlPSOVls  add_vertex {H1P50 ,-5.3, 2251 . 0 )  ; 

H1P50V2S  add_vertex (H1P50 ,-244.1, 2251 . 0 ) ; 

H1P50V3=  add_vertex(HlP50, -244.1,2350.0) ; 

H1P50V4=  add_vertex(HlP50, -5.3,2350.0) ; 

/*  following  ceilings  are  incorrect  leased  on  35*  to  either  side  of  door*/ 

H1P51  =  add_pg(Iil,  144.0, 0, 1)  ;  /*im  421  ceiling*/ 

H1P51V1=  add_vertex(HlP51, 103.3,2206.6) ; 

H1P51V2=  add_vertex(HlP51, 342.1,2206.6)  ,- 
H1P51V3=  add_vertex(HlP51, 342.1,2099.5) ; 

H1P51V4=  add_vertex(HlP51, 103.3,2099.5) ; 

H1P52  =  add_pg(Hl, 144.0, 0, 1) ;  /*rm  531  ceiling*/ 

H1P52V1=  add_vertex(HlP52, 103.3, 1972.7) ; 

H1P52V2=  add_vertex(HlP52, 342.1, 1972.7) ; 

H1P52V3=  add_vertex (H1P52 ,342.1, 1865 . 6)  ; 

H1P52V4=  add_vertex(HlP52, 103.3,1865.6)  ; 

H1P53  =  add_pg(Hl, 144.0, 0, 1) ;  /*nn  529  ceiling*/ 

H1P53V1S  add_vertex(HlP53, 103.3, 1779.5) ; 

H1P53V2S  add_vertex(HlP53, 342.1, 1779.5) ; 

H1P53V3=  add_vertex(HlP53, 342.1, 1672.4) ; 

H1P53V4=  add_vertex(HlP53, 103 .3, 1672.4)  ; 

H1P54  =  add_pg(Hl, 144.0, 0, 1) ;  /*nn  527  ceiling*/ 

H1P54V1=  add_vertex(HlP54, 103.3, 1557.4) ; 

H1P54V2=  add_vertex(HlP54, 342. 1,1557. 4) ; 

H1P54V3=  add_vertex (H1P54, 342. 1,1450. 3 ) ; 

H1P54V4=  add_vertex(HlP54, 103 .3, 1450.3)  ; 

H1P55  =  add_pg(Hl, 144. 0,0,1);  /*nn  525  ceiling*/ 

H1P55V1=  add_vertex(HlP55, 103 ,3, 1377.7) ; 

H1P55V2=  add_vertex(HlP55, 342. 1,1377. 7) ; 

H1P55V3=  add_vertex(HlP55, 342.1,1270.6)  ; 

H1P55V4=  add_vertex(HlP55, 103.3,1270.6)  ; 

H1P56  =  add_pg{Hl, 144.0, 0, 1) ;  /*nn  523  ceiling*/ 

H1P56V1=  add_vertex(HlP56, 103.3,1153.8)  ; 

H1P56V2=  add_vertex(HlP56, 342.1,1153.8)  ; 

H1P56V3=  add_vertex(HlP56, 342.1, 1046.7) ; 

H1P56V4=  add_vertex(HlP56, 103.3, 1046.7) ; 

H1P57  =  add_pg(Hl, 144 .0, 0, 1) ;  /*nn  521  ceiling*/ 

HI P57 VI =  add_ver t ex (H1P57, 103.3, S’l.l); 

H1P57V2=  add_vertex(HlP57,342.1,831.1) ; 

H1P57V3=  add_vertex(HlP57, 342.1,724.0) ; 

H1P57V4=  add_vertex(HlP57, 103.3,724.0) ; 
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H1P58  ■  add_pg(Hl, 144.0, 0, 1) ;  /*zm  519  ceiling*/ 

H1P58V1X  add_v*rt«x(HlP58.103.3,599.5) ; 

H1P58V2X  add_vartax(HlP58.342.1.599.5) ; 

H1P58V3X  add_vartax {H1P58. 342.1,492.4) ; 

H1P58V4=  add_vartax(HlP58, 103.3,492.4) ; 

H1P59  X  add_pg(Hl, 144. 0,0,1);  /Tm  ?  ceiling*/ 

H1P59V1X  add_vertax(HlP59,221.7,419.2) ; 

H1P59V2X  add_vertex(HlP59,221.7,500.0) ; 

H1P59V3X  add_vertax(HlP59, 300. 0,500.0) ; 

H1P59V4X  add_vertex(HlP59,300.0,419.2) ; 

H1P60  X  add_pg(Hl, 144.0, 0, 1) ;  /*  office  ceiling*/ 

HlPeOVlx  add_vertcx(HlP60, 342.8, 600.0) ; 

H1P60V2=  add_vertex(HlP60,449.9,600.0) ; 

H1P60V3X  add_vertex(HlP60, 449.9,330.0)  ; 

H1P60V4=  add_vertex{HlP60, 342.8, 330.0) ; 

H1P61  X  add_pg(Hl, 144.0, 0, 1) ;  /*nn  511  ceiling*/ 

H1P61V1X  add_vertex(HlP61, 342.8,  315.0)  ; 

H1P61V2X  add_vertex(HlP61,449.9,315.0)  ; 

HlP61V3x  add_vertex(HlP61, 449.9, 0.0)  ; 

H1P61V4X  add_vertex(HlP61, 342.8,  0.0) ; 

H1P62  X  add_pg (HI, 144 . 0, 0, 1 ) ;  /*nn  stairwell  ceiling*/ 

H1P62V1X  add_vertex(HlP62, 103.3,125.0) ; 

H1P62V2X  add_vertex(HlP62, 150.0,125.0) ; 

H1P62V3X  add_vertex(HlP62, 150.0,40.0) ; 

H1P62V4X  add_vertex(HlP62, 103.3,40.0)  ; 

/*  Don't  forget  to  add  the  ceiling  associations  or  else  we  can't  tell 
how  high  each  section  of  the  hallway  is*/ 

add_ceiling(HlPl,HlP2)  ; 
add_ceiling(HlPl,HlP3) ; 
add_ceiling(HlPl,HlP4) ; 
add_ceiling (HlPl, H1P5) ; 
add_ceiling(HlPl,HlP6) ; 
add_ceiling(HlPl,HlP7) ; 
add_ceiling (HlPl, H1P8) ; 
add_ceiling(HlPl,HlP9) ; 
add_ceiling(HlPl,HlP10)  ; 
add_ceiling(HlPl,HlPll)  ; 
add_ceiling(HlPl,HlP12) ; 
add_ceiling(HlPl,HlP13) ; 
add_ceiling(HlPl,HlP14)  ; 
add_ceiling(HlPl,HlP15) ; 
add_ceiling(HlPl,HlP16) ; 
add_ceiling(HlPl,HlP17) ; 
add_ceiling(HlPl,HlP18)  ; 
add_ceiling(HlPl,HlP19) ; 
add_ceiling(HlPl,HlP20) ; 
add_ceiling(HlPl,HlP21)  ; 
add_ceiling(HlPl,HlP22)  ; 
add_ceiling{HlPl,HlP23) ; 
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add_c«iling(HlPl,HlP24) ; 
add_c«iling(HlPl,HlP25) ; 
add_ceiling(HlPl.HlP26) ; 
add_cailing{HlPl.HlP27) ; 
add_ceiling(HlPl,HlP28) ; 
add_ceiling(HlPl.HlP29) ; 
add_ceiling(HlPl,HlP30) ; 
add_ceiling(HlPl,HlP31) ; 
add_ceiling{HlPl.HlP32) ; 
add_cailing(HlPl,HlP33) ; 
add_ceiling(HlPl,HlP34) ; 
add_cailing(HlPl.HlP35) ; 
add_ceiling(HlPl,HlP36) ; 
add_ceiling(HlPl,HlP37) ; 
add_ceiling(HlPl.HlP38) ; 
adcLceiling(HlPl,HlP39) ; 
add_ceiling(HlPl,HlP40) ; 
add_ceiling(HlPl,HlP41) ; 
add_ceiling(HlPl,HlP42) ; 
add_ceiling(HlPl.HlP43) ; 
add_ceiling(HlPl,HlP44) ; 
add_ceiling(HlPl,HlP45)  ; 
add_ceiling(HlPl,HlP46) ; 
add_ceiling(HlPl,HlP47) ; 
add_ceiling (HlPl, H1P48) ; 
add_ceiling(HlPl,HlP49) ; 
add_ceiling(HlPl,HlP50)  ; 
add_ceiling(HlPl,HlP51)  ; 
add_ceiling(HlPl,HlP52)  ; 
add_ceiling(HlPl,HlP53) ; 
add_ceiling(HlPl,HlP54) ; 
add_ceiling(HlPl,HlP55)  ; 
add_ceiling(HlPl,HlP56)  ; 
add_ceiling(HlPl,HlP57)  ; 
add_ceiling(HlPl,HlP58) ; 
add_ceiling(HlPl,HlP59)  ; 
add_ceiling(HlPl,HlP60) ; 
add_ceiling(HlPl,HlP61) ; 
add_ceiling(HlPl,HlP62)  ; 
add_ceiling(HlPl,HlP63)  ; 
add_ceiling (HlPl, H1P64) ; 

/*  Vertical  edges  must  alway  be  explicitly  added  */ 
add_edge ( HIPIVI , H1P2V1 ) ; 

add_edge(HlPlV2,HlP4Vl) ;  /*link  up  vert  edges  of  room  506*/ 

add_edge (HlPlV2a, H1P4V2 ) ; 

add_edge (HlPlV2b, H1P34V1) ; 

add_edge(HlPlV2c,HlP34V2) ; 

add_edge (HlPlV2d, H1P34V3 ) ; 

add_edge {HlPlV2e , H1P34V4 ) ; 
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addL«dg«(HlPlV2£,HlP4V3) ; 
addLadg* (H1P1V3 , H1P4V4 ) ; 

add_adga(HlPlV4,HlP5Vl) ;  /*link  up  vart  adgas  of  room  510*/ 

addLadga (HlPlV4a, H1P5V2 ) ; 

addLadga (HlPlV4b, H1P35V1) ; 

add_adga(HlPlV4c,HlP35V2) ; 

addLadga(HlPlV4d,HlP35V3); 

addLadga (HlPlV4a,HlP35V4) ; 

adcLadga(HlPlV4£,HlP5V3) ; 

add_adga (H1P1V5 . H1P5V4 )  ; 

add_adga(HlPlV6,HlP6Vl) ;  /*link  up  vart  adgas  of  room  512  */ 

addl_adga (HlPlV6a, H1P6V2 )  ; 

add_adga(HlPlV6b,HlP3fiVl) ; 

add_adga(HlPlV6c,HlP36V2) ; 

add_adga (HlPlV6d, H1P36V3 ) ; 

add_adga(HlPlV6a.HlP36V4) ; 

adcLadga(HlPlV6f.HlP6V3) ; 

add_adga (H1P1V7 , H1P6V4 ) ; 

add_edga(HlPlV8, H1P7V1) ;  /*link  up  vert  edgas  of  room  514*/ 

adcLadge (HlPlVSa, H1P7V2 ) ; 

addLadga {HlPlV8b,HlP37Vl) ; 

add_adga(HlPlV8c,HlP37V2) ; 

addLadga (HlPlVSd. H1P37V3 ) ; 

addLadga (HlPlV8a,HlP37V4) j 

adcLadge(HlPlV8f,HlP7V3); 

addLadga ( HI P1V9, HI P7V4) ; 

add_adga(HlPlV10,HlP8Vl) ;  /*link  up  vert  edges  of  room  516*/ 

add_edge(HlPlV10a,HlP8V2) ; 

add_edge(HlPlV10b.HlP38Vl) ; 

add_adge(HlPlV10c,HlP38V2) ; 

add_edge(HlPlV10d,HlP38V3) ; 

add_a'age(HlPlV10e,HlP38V4)  ; 

add_edge{HlPlV10f ,H1P8V3) ; 

add_edge(HlPlVll,HlP8V4) ; 

add_edge(HlPlV12,HlP9Vl) ;  /*link  up  vert  edges  of  room  518*/ 

add_edge(HlPlV12a,HlP9V2) ; 

add_edge(HlPlV12b.HlP39Vl) ; 

add_odge(HlPlV12c.HlP39V2) ; 

add_adge (HlPlV12d, H1P39V3 ) ; 

add_edge(HlPlV12e,HlP39V4) ; 

addLadge(HlPlV12f ,H1P9V3) ; 

addLadga (H1P1V13,H1P9V4) ; 

add_edge(HlPlV14,HlP10Vl) ;  /*link  up  vert  edges  of  room  520*/ 

addLadge(HlPlV14a.HlP10V2) ; 

add_adg«(HlPlV14b,HlP40Vl) ; 

add_adga(MlPlV14c,HlP40V2) ; 

addLadga (HlPlV14d, H1P40V3 ) ; 

addLadga (HlPlV14a,HlP40V4) ; 

add_adga(HlPlV14f,HlP10V3) ; 

add_adga(HlPlV15,HlP10V4) ; 

add_adga (H1P1V16,H1P11V1) ;  /*link  up  vert  adgas  of  room  522R*/ 
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adcL®dge(HlPlV16a,HlPllV2) ; 
add_adge(HlPlV16b.HlP41Vl) ; 
add_edg#(HlPlV16c,HlP41V2) ; 
add_edge (HlPlV16d. H1P41V3 ) ; 
add_adga(HlPlV16e,HlP41V4) ; 
add_«dg«(HlPlV16f,HlPllV3) ; 
add_«dge(HlPlV17,HlPllV4) ; 
add_#dg*(HlPlV18.HlP12Vl) ; 
add_adge(HlPlV18a,HlP12V2) ; 
add_adg«(HlPlV18b,HlP42Vl) ; 
add_adge(HlPlV18c,HlP42V2) ; 
add_adge (HlPlV18d, H1P42V3 )  ; 
add_edge(HlPlV18«,HlP42V4) ; 
add_edge(HlPlV18f.HlP12V3)  ; 
add_edge(HlPlV19,HlP12V4) ; 
adcLedge(HlPlV20,HlP13Vl) ; 
add_edge(HlPlV20a.HlP13V2) ; 
add_edge(HlPlV20b,HlP43Vl)  ; 
add_edge(HlPlV20c.HlP43V2) ; 
add_edge(HlPlV20d,HlP43V3) ; 
add_edge(HlPlV20e,HlP43V4) ; 
add_edge(HlPlV20f ,H1P13V3)  ; 
add_edge{HlPlV21.HlP13V4) ; 
add_edge(HlPlV22,HlP44Vl) ; 
add_edge(HlPlV22a,HlP44V2) ; 
add_edqe(HlPlV22b,HlP44V3) ; 
add_edge(HlPlV23,HlP44V4) ; 
add_edge(HlPlV24,HlP14Vl)  ; 
add_edge(HlPlV24a,HlP14V2) ; 
add_edge(HlPlV24b,HlP45Vl) ; 
add_edge(HlPlV24c,HlP45V2) ; 
add_edge(HlPlV24d,HlP45V3) ; 
add_edge(HlPlV24e,HlP45V4) ; 
add_edge(HlPlV24f,HlP14V3) ; 
add_edge(HlPlV25,HlP14V4) ; 
add_edge(HlPlV26,HlP15Vl) ; 
add_edge (HlPlV26a, H1P15V2) ; 
add_edge(HlPlV26b,HlP46Vl) ; 
add_edge(HlPlV26c,HlP46V2) ; 
add_edge (HlPlV26d, H1P46V3 ) ; 
add_edge(HlPlV26e,HlP46V4) ; 
add_edge(HlPlV26f ,H1P15V3) ; 
add_edge{HlPlV27,HlP15V4) ; 
add_edge(HlPlV28,HlP16Vl) ; 
add_edge(HlPlV28a,HlPieV2) ; 
add_edge(HlPlV28b,HlP47Vl) ; 
add_edge(HlPlV28c,HlP47V2) ; 
add.edge (HlPlV28d, H1P47V3 ) ; 
add_edge(HlPlV28e,HlP47V4) ; 
add_edge (HlPlV28f , H1P16V3 ) ; 
add_edge(HlPlV29,HlP16V4) ; 


/•link  up  vert  edges  of  room  FDl*/ 


/•link  up  vert  edges  of  room  524^/ 


/•link  up  vert  edges  of  water  fountain^/ 


/•link  up  vert  edges  of  room  52 6R^/ 


/•link  up  vert  edges  of  room  528A^/ 


/•link  up  vert  edges  of  room  52BB*/ 
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ad<i_«dg«(HlPlV30,HlP17Vl)  ; 
add_«dg«(HlPlV30a,HlP17V2) , 
add^adga(HlPlV30b,HlP48Vl) : 
add_«dga (H1P1V30C, H1P48V2 ) 
add_adga (HlPlV30d, H1P48V3 ) 
add_adga (HlPlV30a, H1P48V4 ) 
add_«dga(HlPlV30f ,H1P17V3) ^ 
add_adga(HlPlV31,HlP17V4) ; 
add_adga(HlPlV32.HlP18Vl) ; 
add_adga (HlPlV32a. H1P18V2) 
add_*dga (HlPlV32b, H1P49V1 ) 
add_adga (H1P1V32C. H1P49V2) 
add.*dga (HlPlV32d, H1P49V3 ) 
add_adge (HlPlV32a, H1P49V4 ) 
add^adga (H1P1V32£ . H1P18V3 ) 
add_adge(HlPlV33,HlP18V4) ; 
^dd_adge(HlPlV34.HlP19Vl) ; 
add_edge ( HI PI V3  4a , HI PI 9 V2 ) 
add_edge (HlPlV34b, H1P50V1 ) 
add_adga (HlPlV34c , H1P50V2 ) 
add_edge {HlPlV34d, H1P50V3 ) 
add_edge (HlPlV34e. H1P50V4 ) 
add_adga (HlPlV34f . H1P19V3 ) 
add_adge(HlPlV35,HlP19V4) ; 
add_adge(HlPlV36,HlP2V2) ; 
add_edge(HlPlV37,HlP2V3) ; 
add_edge(HlPlV38,HlP2QVl) ; 
ada_edge ( HI P1V3  8a , HI P2  0V2 ) 
add_edge (HlPlV38b, H1P51V1 ) 
add_edge (H1P1V38C, H1P51V2 ) 
add_adge (HlPlV38d, H1P51V3 ) 
add_edge (HlPlV38e,HlP51V4) 
add_edge (HlPlV38f , H1P20V3 ) 
add_edge(HlPlV39,HlP20V4) ; 
add_edge{HlPlV40,HlP21Vl) ; 
add_edge(HlPlV40a,HlP21V2) 
add_edge (HlPlV40b. H1P52V1 ) 
add_adge ( H1P1V4  Oc , HI P52V2 ) 
add_edge (HlPlV40d, H1P52V3 ) 
add_adge (HlPlV40e , H1P52V4 ) 
add_adge { HI PI V4  0  £ , HI P2 1 V3 ) 
add_edge(HlPlV41,HlP21V4) ; 
add_edge(HlPlV42,HlP22Vl) ; 
add_edge (HlPlV42a, H1P22V2 ) 
add_«dge (HlPlV42b, H1PS3V1 ) 
add_«dge (HlPlV42c, H1P53V2 ) 
add_adga (HlPlV42d, H1P53V3 ) 
add_adga (HlPlV42e, H1P53V4} 
add_adge (H1P1V42£,H1P22V3 ) 
add^edge (H1P1V43 , H1P22V4 ) ; 
add_edge(HlPlV44,HlP23Vl) ; 


/*link  up  vart  adgaa  o£  room  530A*/ 


/*link  up  vart  adgas  of  room  530B*/ 


/*link  up  vart  adgas  of  room  53 OC*/ 


/•corner*/ 

/•corner*/ 

/•link  up  vert  edges  of  room  421*/ 


/•link  up  vart  edges  of  room  531*/ 


/•link  up  vart  edges  of  room  529*/ 


/•link  up  vert  edges  of  room  527*/ 
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add_«dg« (HlPlV44a, H1P23V2 ) 
add_edga (HlPlV44b, H1P54V1 ) 
addLadga (H1P1V44C. H1P54V2 ) 
add_adga (HlPlV44d, H1P54V3 ) 
add_adge (HlPlV44e, H1P54V4 ) 
addLadga (HlPlV44f. H1P23V3 ) 
addLadga (H1P1V45, H1P23V4) ; 
add_adga(HlPlV46,HlP24Vl) ; 
add_adga (HlPlV46a. H1P24V2 ) 
addLadga (HlPlV46b, H1P55V1 ) 
addLadga (H1P1V46C. H1P55V2) 
add_adga (HlPlV46d, H1P55V3 ) 
add_adge (HlPlV46e, H1P55V4) 
add_adga (H1P1V46£. H1P24V3 ) 
add_adga (H1P1V47 , H1P24V4 ) ; 
add_edga (H1P1V48, H1P25V1 ) ; 
add_adga(HlPlV48a,HlP25V2) 
add_adga (HlPlV48b, HI PS 6 VI ) 
add_edga (HlPlV48c. H1P56V2 ) 
add_edga (HlPlV48d, H1P56V3 ) 
add_adge (HlPlV48e, H1P56V4 ) 
add_adga {HlPlV48f,HlP25V3) 
add_adga (H1P1V49 , H1P25V4 ) ; 
add_edga(HlPlV50,HlP26Vl) ; 
add_edge(HlPlV50a.HlP26V2) ; 
add_edge(HlPlV50b,HlP57Vl) ; 
add_adge(HlPlV50c.HlP57V2) ; 
add_edge(HlPlV50d,HlP57V3) ; 
add_adge(HlPlV50e,HlP57V4) ; 
add_edge(HlPlV50f,HlP26V3) ; 
add_edge(HlPlV51,HlP26V4) ; 
add_edge (H1P1V52 , H1P27V1 ) ; 
add_edge{HlPlV52a,HlP27V2) ; 
add_adge{HlPlV52b.HlP58Vl) ; 
add_edge(HlPlV52c,HlP58V2) ; 
add_edge(HlPlV52d,HlP58V3) ; 
add_edge(HlPlV52e,HlP58V4) ; 
add_edge(HlPlV52f,HlP27V3) ; 
add.edge {H1P1V53 , H1P27V4 ) ; 
add_edge (H1P1V54 , H1P3V2 ) ; 
add_edge (H1P1V55 . H1P28V1 ) ; 
add_edge(HlPlV55a,HlP28V2) ; 
add_adge(HlPlV55b.HlP59Vl) ; 
add_edge{HlPlV55c,HlP59V2) ; 
addLadga (HlPlVSSd, H1P59V3 ) ; 
add_edge (HlPlVSSa, H1P59V4) ; 
add_edge (HlPlVSSf , H1P28V3 ) ; 
add_adge {H1P1V56 , H1P28V4 ) ; 
add_adge (H1P1V57 , H1P3V3 ) ; 
add_edge(HlPlV58,HlP29Vl) ; 
add_edge{HlPlV58a.HlP29V2) ; 


/•link  up  vart  adgas  of  room  525*/ 


/•link  up  vert  edges  of  room  523 •/ 


/•link  up  vert  edges  of  room  521 •/ 


/•link  up  vert  edges  of  room  519^/ 


/ •corner •/ 

/•link  up  vert  edges  of  room  ?•/ 


/ •corner •/ 

/•link  up  vert  edges  of  office  515  •/ 
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adcL«dg«  (HlPlVSSb,  H1P60V1 )  ; 
add_«dg«(HlPlVS8c,HlP60V2) ; 
add_«dga (HlPlVSSd, H1P60V3 ) ; 
add_adg«(HlPlV58a,HlP60V4) ; 
add_adg«(HlPlV58£,HlP29V3); 
add_*dga(HlPlV59.HlP29V4); 

add_adga(HlPlV60,HlP30Vl) ;  /*link  up  vart  adgaa  of  room  511  */ 

add_adga(HlPlV60a,HlP30V2) ; 

add_«dga(HlPlV60b,HlP61Vl) ; 

add_adga(HlPlV60c,HlP61V2) ; 

add_adga(HlPlV60d,HlP61V3) ; 

add_adga(HlPlV60a.HlP61V4) ; 

add_odg«(HlPlV60£,HlP30V3) ; 

add_adga(HlPlV61,HlP30V4)  ; 

add_adga(HlPlV62.HlP3V4) ;  /‘cornar*/ 


add_edge(HlPlV63,HlP63Vl) ;  /*link  up  vart  adges  of  rotan  alav  1*/ 

add_edge(HlPlV63a.HlP63V2) ; 

add_adge(HlPlV63b.HlP31Vl) ; 

add_adga(HlPlV63c.HlP31V2) ; 

add_edge(HlPlV63d,HlP31V3) ; 

add_edge{HlPlV63e,HlP31V4) ; 

add_edge(HlPlV63f ,H1P31V5) ; 

add_adge (HlPlV63g, H1P63V3 ) ; 

add_edga(HlPlV64,HlP63V4) ; 

add_adge(HlPlV65,HlP64Vl) ;  /'link  up  vert  edges  of  room  elev  2*/ 

add_edge(HlPlV65a,HlP64V2) ; 

add_edge(HlPlV65b,HlP32Vl) ; 

add_edge(HlPlV65c,HlP32V2) ; 

add_edge(HlPlV65d,HlP32V3); 

add_edge(HlPlV65e,HlP32V4); 

add_edge(HlPlV65f ,H1P32V5) ; 

add_edge(HlPlV65g,HlP64V3) ; 

add_edge(HlPlV66,HlP64V4) ; 


add_edge(HlPlV67,HlP3Vl) ;  /*corner*/ 

add_edge(HlPlV68,HlP33Vl) ;  /*link  up  vert  edges  of  stairwell*/ 

add_edge(HlPlV68a,HlP33V2) ; 

add_edge (HlPlV68b, H1P62V1 ) ; 

add_edge (HlPlV68c , H1P62V2 ) ; 

add_edge (HlPlV68d, H1P62V3 ) ; 

add_edge(HlPlV68e,HlP62V4) ; 

add^edge(HlPlV68f.HlP33V3); 

add_edge(HlPlV69,HlP33V4) ; 

add_edge(HlPlV70.HlP2V4) ;  /‘corner*/ 


/*  Now  define  the  different  classes  of  doors  and  put  instances  inside  the 
door  jeuns  */ 
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adcLinstanc*( 'hallway *,7, HI, O.O.O.O.O.O.O.O.O.O.O.O); 

H2*addjph('office_door', 11, W, 0, 1) ; 

H2Pl«add_pg (H2 , 0 . 0 , 1 , 1 ) ; 

H2P1V1  X  add_v«rtex(H2Pl, 0.0, 0.0) ; 

H2P1V2  X  add_vartex(H2Pl, 1.75, 0.0); 

H2P1V3  X  add_vartax{H2Pl,1.75,35.5) ; 

H2P1V4  X  add_vart«x(H2Pl,0.0,35.5); 

H2P2xad<l_psr(H2,83.5,0,l)  ; 

H2P2V1  X  add_vartax (H2P2 , 0 . 0 , 0 . 0 ) ; 

H2P2V2  X  add_vartex(H2P2, 1.75,  0.0); 

H2P2V3  X  adcLvertax{H2P2, 1.75, 35.5) ; 

H2P2V4  X  add_vertex(H2P2,0.0,35.5); 

add_edge  (H2P1V1,H2P2V1) ;  /*lin)c  up  vert  adges  of  door*/ 

adcLedge (H2P1V2 , H2P2V2 ) ; 

add_edge (H2P1V3 , H2P2V3 ) ; 

add_edge {H2P1V4 , H2P2V4 )  ; 

add_ceiling{H2Pl,H2P2) ; 

add_instance(  '•door506“ ,  7,H2,  -5.3,239.6,0.2,0.0,0.0,0.0); 
add_instance ( •door510* , 7,H2, -5. 3, 7 13. 8, 0.2, 0.0, 0.0, 0.0); 
add_instanc€Cdoor512‘,7,H2,-5.3,861.5,0.2,0.0,35.5,0.0)  ; 
add_instance ( •door514* , 7, H2 , -5.3,937.6,0.2,0.0,0.0,0.0); 
add_instance (•door516', 7, H2, -5.3,1085.3,0.2,0.0,35.5,0.0)  ; 
add_instance ( •door518  * , 7, H2, -5, 3, 1161. 8, 0.2, 0.0, 0.0, 0.0); 
add_instance (■door520*, 7, H2, -5.3,1309.0,0.2,0.0, 35.5,0.0); 
add_instance (•door524', 7, H2, -5.3, 1618.9,0.2, 0.0, 35.5,0.0); 
add_instance ( •door528A* , 8, H2, -5. 3, 183 6. 5, 0.2, 0.0, 0.0, 0.0); 
add_instance ( •door528B' , 8, H2, -5. 3, 19 19. 2, 0.2, 0.0, 0.0, 0.0); 
add_instance( •door530A* , 8, H2, -5. 3, 2030. 5, 0.2, 0.0, 0.0, 0.0); 
add_instance ( 'doorSlOB* , 8,H2, -5 . 3 , 2230.7, 0.2,0.0,35.5,0.0); 
add_instance( •door530C" , 8,H2, -5.3,2253.9, 0.2, 0.0, 0,0, 0.0); 
add_instance ( •door42 l',7,H2,103.3,2136.3,0.2,1.75,0.0,0,0); 
add_instance (•door525*, 7, H2, 103.3,1342.6, 0.2, 1.75,35.5,  0.0) ; 
add_instance(’'door523',7,H2,103.3,1118.7,0.2,1.75,35.5,0.0)  ; 
add_instance (■door521', 7, H2, 103.3,796.0,0.2, 1.75,35.5, 0.0) ; 
add_instanceCdoor519',7,H2,103.3,564.4,0.2,1.75,35.5,0.0)  ; 
add_instance('door?',5,H2,293.8,415.65,0.2,0.0,35.5,90.0) ; 
add_instance( •door511' , 7, H2, 342.8, 310.1,  0.2, 1.75, 35.5,  0.0) ; 
add_instance{ "doorstairs* , 10,H2,103.3,64.4,0.2,1.75,0.0,0.0); 

H3xadd_ph{ 'fire.door* , 9,W, 0, 1) ; 

H3Pl=add_pg(H3,0.0,l,l) ; 

H3P1V1  X  add_vertex(H3Pl,0.0,0.0) ; 

H3P1V2  X  add_vertex(H3Pl, 1,75, 0.0) ; 

H3P1V3  X  add_vertex(H3Pl, 1.75, 35.6) ; 

H3P1V4  X  add_vertex(H3Pl,0.0,35.6); 

H3P2=add_pg(H3, 82.9, 0,1) ; 

H3P2V1  X  add_vertex(H3P2,0.0,0.0) ; 
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H3P2V2  *  ad<i_v«rt«x(H3P2. 1.75,  0.0); 

H3P2V3  «  add_v*rt*x(H3P2.1.75.35.€) ; 

H3P2V4  s  add_vertax(H3P2.0.0,35.6); 

add_adga ( H3 PlVl , H3 P2V1 ) ;  /*link  up  vert  edges  of  door*/ 

add^edge (H3P1V2 , H3P2V2 ) ; 
add^edge (H3P1V3 . H3P2V3 ) ; 
addLedge ( H3  P1V4 . H3  P2V4 ) ; 

adcLceiling(H3Pl,H3P2) ; 

add^instance ( * Ist.fire.door 1  * .13.H3.-5.5.1488.3.0.2,0.0,0.0.0.0); 
add_in8tance(*lst_fire_door2*.13,H3.-5.5.1559.7,0.2.0.0.35.6,0.0) ; 


H4sadd_ph( "restroonudoor* , 13.W, 0, 1) ; 
H4Pl*add_pg(H4,0.0.1,l) ; 

H4P1V1  a  add_vertex(H4P1.0.0,0.0) ; 

H4P1V2  =  add_vertex(H4Pl, 1.75.0.0) ; 

H4P1V3  =  add_vertex(H4Pl, 1.75, 31.5); 

H4P1V4  a  add_vertex(H4Pl,0.0.31.5); 

H4P2=add_pg(H4, 83.25,  0,1)  ; 

H4P2V1  a  add_vertex(H4P2, 0.0, 0.0) ; 

H4P2V2  a  add_vertex(H4P2, 1.75, 0.0) ; 

H4P2V3  a  add_vertex(H4P2, 1.75, 31.5) ; 

H4P2V4  a  add_vertex(H4P2, 0.0, 31.5) ; 
add_edge(H4PlVl,H4P2Vl) ; 
add_edge (H4P1V2 , H4P2V2 ) ; 
add.edge (H4P1V3 , H4P2V3 ) ; 
add_edge (H4P1V4 , H4P2V4 ) ; 

add_ceiling(H4Pl,H4P2)  ; 

add_instanceCdoor522R*,8,H4,-5.3,1461.0,0.2,0.0,31.5,0.0); 
add_instance(-door526R*,8,H4,-5.3,1785.9,0.2,0.0,31.5,0.0)  ; 

H5aadd_ph( •double_door " , 11, W, 0, 1) ; 

H5Pl=add_pg  (H5,  0  .  0,  1,  1)  ; 

H5P1V1  a  add_vertex(H5Pl,0.0,0.0) ; 

H5P1V2  a  add_vertex(H5Pl, 1.75, 0.0) ; 

H5P1V3  a  add_vertex(H5Pl, 1.75,29.6) ; 

H5P1V4  a  add_vertex(H5Pl, 0.0,29.6) ; 
H5P2=add_pg(H5,82.9,0,l); 

H5P2V1  a  add_vertex(H5P2,0.0,0.0) ; 

H5P2V2  a  add_vertex(H5P2, 1.75, 0.0); 

H5P2V3  a  add_vertex{H5P2, 1.75,29.6) ; 

H5P2V4  a  add_vertex(H5P2,0.0,29.6); 

add_edge(H5PlVl,H5P2Vl) ;  /•lin)t  up  vert  edges  of  door*/ 
add_edge (H5P1V2 , H5P2V2 ) ; 
add_edge {H5P1V3 , H5P2V3 ) ; 
add_edge (H5P1V4 , H5P2V4 ) ; 


72 


add_c«iling(H5Pl,H5P2)  ; 


add_instance(*ldoor531-,8.H5,103.3.1937.4.0.2.1.75.29.6.0.0); 
add_instancaC2door531',8.H5,103.3,1878.0,0.2,1.75,0.0.0.0)  ; 
add_instancaCldoor529-,8.H5. 103.3,1744.2.0.2,1.75,29.6,0.0)  ; 
add_instance(*2door529*, 8,H5, 103 . 3 , 1^84 .8, 0 .2, 1 .75, 0 . 0,  0 . 0) ; 
add_in8tanceCldoor527-,8,H5,103.3.1522.1,0.2.1.75,29.6,0.0)  ; 
add_instanceC2door527*,8,H5,103.3,1462.7,0.2,1.75,0.0,0.0)  ; 
add_instanceCldoor_officaM2,H5,339.25,402.3,0.2,1.75,29.6,0.0)  ; 
add_instanc®C2door_office*,12,H5,339.25,342.9,0.2,1.75,0.0,0.0) ; 


/*  Notice  that  lights  have  no  height  */ 

H6*add_ph ( ' 1 ight •,5,W,1,1); 

H6Pl=add_pg(H6,0.0,l,l) ; 

H6P1V1  =  add_vertex(H6Pl, 0.0, 0.0) ; 

H6P1V2  =  add_vertex(H6Pl,45.5,0.0) ; 

H6P1V3  =  add_vertex(H6Pl,45.5,21.25)  ; 

H6P1V4  =  add_vertex(H6Pl,0.0,21.25); 

add_instance ( "lightl* , 6, H6, 26 .25, 98.5, 102.0, 0. 0,0. 0,0.0), • 
add_instance ( ■ light2 ■.6,H6,26.25,362.75,102.0,0.0.0.0,0.0); 
add_instance (" light! ■, 6, H6, 26. 25, 651. 0,102.0,  0.0, 0.0, 0.0) ; 
add_instance ( *light4* , 6, H6, 26.25, 915 .25, 102.0,0.0,0.0,0.0); 
add_instanceClight5*,6,H6,26.25,1251.5,102.0,  0.0, 0.0,0.0)  ; 
add_instanceClight6‘,6,H6,26.25,1539.75,102.0,0.0,0.0,0.0)  ; 
add_instanceClight7*,  6, H6, 26. 25, 1828. 0,102.0,  0.0,  0.0, 0.0)  ; 
add_instance ( “lights* , 6, H6, 26.25, 2140.25, 102.0, 0, 0,0, 0,0.0), • 

/*  Since  all  molding  sizes  are  different,  we  need  to  add  a  separate 
polyhedron  for  each  one.  But  we  still  need  to  add  one  instance 
of  each  so  it  will  appear  in  the  model*/ 

/*  37  differe.nt  molding  pieces  */ 

H7=add_ph( "moldingl* ,  8,W,  1, 1)  ; 

H7Pl=add_pg(H7,0.0,l,l)  ; 

H7P1V1  =  add_vertex(H7Pl,0.0,0.0); 

H7P1V2  =  add_vertex(H7Pl,0.2,0.0) ; 

H7P1V3  =  add_vertex(H7Pl,0.2,237.5) ; 

H7P1V4  =  add_vertex(H7Pl, 0.0,237.5); 

H7P2=add_pg (H7 , 3 . 875, 0 , 1 ) ; 

H7  P2 VI  =  add_vertex ( H7  P2 , 0 . 0 , 0 . 0 ) ; 

H7P2V2  =  add_vertex(H7P2,0.2,0.0); 

H7P2V3  =  add_vertex (H7P2, 0.2, 237.5 ); 

H7P2V4  *  add_vertex(H7P2,0.0,237.5) ; 
add_edge (H7P1V1 , H7P2V1 ) ; 
add_edge (H7P1V2 , H7P2V2 ) ; 
add_edge (H7P1V3 , H7P2V3 ) ; 
add_edge (H7P1V4 , H7P2V4 )  ; 
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add_ceilino(H7Pl,H7P2) ; 

add_instanc* { ‘moldingl • , 8, H7, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0); 

H8sadd_j>h  ( *inolding2  •,8,W,1,1); 

H8Pl=add_pg(H8,0.0,l,l) ; 

H8P1V1  a  add_vartax(H8Pl, 0.0, 0.0) ; 

H8P1V2  *  add_vartax(H8Pl,0.2,0.0) ; 

H8P1V3  s  add_vertex(H8Pl, 0.2, 434.5); 

H8P1V4  X  add_vertex(H8Pl,0.0,434.5); 
H8P2=add_pg(H8,3.875,0, 1) ; 

H8P2V1  X  add_vertex(H8P2, 0.0, 0.0) ; 

H8P2V2  X  add_vertax(H8P2, 0.2, 0.0) ; 

H8P2V3  X  add_vertex(H8P2,0.2,434.5) ; 

H8P2V4  X  add_vertex{H8P2, 0.0, 434.5); 
add_edge(H8PlVl,H8P2Vl) ; 
add_edge (H8P1V2 , H8P2V2 ) ; 
add_edge (H8P1V3 , H8P2V3 ) ; 
add_edge (H8P1V4, H8P2V4) ; 
add_ceiling (H8P1 ,  H8P2 )  ; 

add_instance ( *niolding2‘' ,  8, H8,  0.0,277.2, 0.0,  0.0,  0.0, 0.0) 

H9xadd_ph( •molding3" , 8,W, 1, 1) ; 

H9Plxadd_pg(H9, 0.0, 1, 1) ; 

H9P1V1  X  add_vertex(H9Pl,0.0,0.0) ; 

H9P1V2  X  add_vertex(H9Pl,0.2,0.0) ; 

H9P1V3  X  add_vertex{H9Pl, 0.2, 72.5); 

H9P1V4  X  add_v«rtex (H9P1, 0.0, 72.5), • 
H9P2=add_pg(H9,3.875,0,l); 

H9P2V1  X  add_vertex(H9P2,0.0,0.0); 

H9P2V2  X  add_vertex(H9P2,0.2,0.0)  ; 

H9P2V3  X  add_vertex{H9P2. 0.2,72.5) ; 

H9P2V4  X  add_vertex(H9P2,0.0,72.5); 
add_edge(H9PlVl,H9P2Vl) ; 
add_edge(H9PlV2,H9P2V2) ; 
add_edge (H9P1V3 , H9P2V3 ) ; 
add_edge{H9PlV4,H9P2V4) ; 
add_ceiling(H9Pl,H9P2) ; 

add_instance(*inolding3* , 8, H9, 0.0, 7 51. 4, 0.0, 0.0, 0.0, 0.0) 

H10xadd_ph{  ■inolding4" ,  8,  W,  1, 1) ; 

H10Plxadd_pg{H10, 0.0, 1, 1) ; 

HIOPIVI  X  add_vertex(H10Pl,0.0,0.0) ; 

H10P1V2  X  add_vertex(H10Pl,0.2,0.0); 

H10P1V3  X  add_vertex(H10Pl, 0.2,71.9) ; 

H10P1V4  X  add_vertex{H10Pl,0.0,71.9); 
H10P2xadd_pg(H10, 3.875, 0,1) ; 

H10P2V1  X  add_vertex(H10P2,0.0,0.0) ; 

H10P2V2  X  add_vertex(H10P2,0.2,0.0) ; 
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H10P2V3  X  «dcLv«rt ax ( HI 0P2, 0.2,71.9) ; 

H10P2V4  X  add_v«rt«x(H10P2,0.0,71.9); 
ad4_«dge(H10PlVl,H10P2Vl) ; 
add_edge(H10PlV2.H10P2V2) ; 
ad<l_adg* (H10P1V3 , H10P2V3 )  ; 
add^edge(H10PlV4,H10P2V4)  ; 
add_ceiling(H10Pl,H10P2) ; 

add_instanc*  ( *inolding4’‘ ,  8.  HIO,  0.0,863.6,0.0,0.0.0.0,0.0); 

Hllxadd_ph( ’moldings* , 8,W, 1, 1) ; 

HllPlxad{l_pg(Hll,  0.0, 1,1); 

HllPlVl  X  add_vertax(HllPl,0.0.0.0); 

H11P1V2  X  add_vartax(HllP1.0.2,0.0) ; 

H11P1V3  X  add_vertex(HllPl, 0.2.72.5); 

H11P1V4  X  ad(l_v«rt«x(HllPl,0.0,72.5); 

HllP2xadd_pg(Hll, 3.875, 0.1)  ; 

H11P2V1  X  add_vert®x(HllP2,  0.0,  0.0)  ; 

H11P2V2  X  add_vertex(HllP2,0.2,0.0)  ; 

H11P2V3  X  add_vertex(HllP2, 0.2,72.5) ; 

H11P2V4  X  add_vertex(HllP2,0.0,72.5); 
add_edge (HllPlVl, HI 1P2 VI) ; 
add_edge(HllPlV2.HllP2V2) ; 
add_edge (H11P1V3 , H11P2V3 ) ; 
add_edge(HllPlV4,HllP2V4) ; 
add_ceiling{HllPl,HllP2) ; 

add^instance ( 'moldings*. 8, Hll, 0.0, 975. 2, 0.0, 0.0, 0.0, 0.0)  ; 

H12xadd_ph(*molding6*,8,W, 1,1); 
H12Plxadd_pg(H12,0.0,l,l) ; 

H12P1V1  X  add_vertex{H12Pl, 0.0, 0.0) ; 

H12P1V2  X  add_vertex(H12Pl, 0.2, 0 .0) ; 

H12P1V3  X  add_vertex(H12Pl, 0.2,72.3); 

H12P1V4  X  add_vertex(H12Pl,0.0,72.3) ; 
H12P2=add_pg(H12,3.875.0.1) ; 

H12P2V1  X  add_vertex(H12P2, 0 .0, 0 .0) ; 

H12P2V2  X  add_vertex(H12P2, 0.2, 0.0) ; 

H12P2V3  X  add_vertex(H12P2, 0.2,72.3) ; 

H12P2V4  X  add_vertex(H12P2, 0.0,72.3) ; 
add_edge(H12PlVl,H12P2Vl) ; 
add_edge(H12PlV2,H12P2V2) ; 
add_edge (H12P1V3 . H12P2V3 ) ; 
add_edge (H12P1V4 . H12P2V4 ) ; 
add_ceiling(H12Pl,H12P2) ; 

add_instance(*molding6*,8,H12,0.0,1087.4,0.0.0.0,0.0,0.0) ; 

H13xadd_ph{*inolding7*,8,W,  1,1)  ; 

H13Plxadd_pg(H13,0.0,l,l) ; 

H13P1V1  X  add_vertex(H13Pl, 0.0, 0.0) ; 
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H13P1V2  =  add_vertex(H13Pl, 0.2,0.0) ; 

H13P1V3  *  add_v*rt«x(H13Pl, 0.2,72.0) ; 

H13P1V4  =  add_v«rtex(H13Pl. 0.0.72.0) ; 
H13P2=add_pg(H13.3.875,0,l) ; 

H13P2V1  =  add_vertex(H13P2,0.0.0.0) ; 

H13P2V2  *  add_v«rt«x(H13P2,0.2.0.0) ; 

H13P2V3  »  add_v«rtax{H13P2. 0.2,72.0) ; 

H13P2V4  =  add_vert*x(H13P2.0.0.72.0); 
add_edge(H13PlVl.H13P2Vl); 
add_«dge(H13PlV2.H13P2V2)  .■ 
add_•dge(H13PlV3.H13P2V3)  ; 
add_edg«(H13PlV4,H13P2V4) ; 
add_ceiling(H13Pl,H13P2); 

add_instance( ■inolding7* , 8, H13, 0.0, 1199. 4. 0.0, 0.0, 0.0, 0.0) 

H14=add_ph( ‘moldingO" , 8, W, 1, 1 ) ; 

H14Pl=add_pg(H14,0.0, 1, 1) ; 

H14P1V1  =  add_vertex(H14Pl, 0.0, 0.0) ; 

H14P1V2  =  add_vertex(H14Pl,0.2.0.0) ; 

H14P1V3  =  add_vertex(H14Pl, 0.2, 116.5); 

H14P1V4  =  add_vertex(H14P1.0.0.116.5) ; 
H14P2=add_pg(H14,3.875,0,l  , 

H14P2V1  =  add_vertex(H14P2,0.0.0.0); 

H14P2V2  =  add_vertex(H14P2, 0.2, 0.0) ; 

H14P2V3  =  add_vertex(H14P2, 0.2, 116.5) ; 

H14P2V4  =  add_vertex(H14P2, 0.0, 116.5) ; 
add_edge(H14PlVl,H14P2Vl) ; 
add_edge(H14PlV2,H14P2V2) ; 
add_edge(H14PlV3,H14P2V3)  ; 
add_edge(H14PlV4,H14P2V4) ; 
add_ceiling(H14Pl,H14P2) ; 

add_instance ( “moldingO* , 8, H14, 0.0, 1311. 1,0. 0,0. 0,0. 0,0.0) 

H15=add_ph(  •inolding9" ,  8,W,  1, 1)  ; 

H15Pl=add_pg(H15, 0.0, 1, 1) ; 

H15P1V1  =  add_vertex(H15Pl,0.0,0.0) ; 

H15P1V2  =  add_vertex(H15Pl,0.2.0.0); 

H15P1V3  =  add_vertex(H15Pl. 0.2,22.7) ; 

H15P1V4  =  add_vertex(H15Pl,0.0,22.7); 
H15P2=add_pg(H15,3.875,0,l) ; 

H15P2V1  =  add_vertex(H15P2,0.0,0.0); 

H15P2V2  =  add_vertex(H15P2,0.2.0.0) ; 

H15P2V3  =  add_vertex(H15P2,0.2,22.7) ; 

H15P2V4  =  add_vertex(H15P2,0.0,22.7); 
add_edge(H15PlVl,H15P2Vl) ; 
add_«dge (H15P1V2 , H15P2V2 ) ; 
add_edge (H15P1V3 , H15P2V3 ) ; 
add_edge{H15PlV4,H15P2V4) ; 
add_ceiling(H15Pl,H15P2)  ; 
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add_instance ( ■inolding9 ■.8,H15,0.0.1463.3.0.0,0.0,0.0,0.0); 

H16=add_ph{ "moldinglO* , 9, W, 1,1); 

H16Pl=add_pg(H16, 0.0, 1, 1) ; 

H16P1V1  =  add_vertex(H16Pl,0.0,0.0) ; 

H16P1V2  =  add_vertex(H16Pl,0.2,0.0); 

H16P1V3  =  add_vertex(H16Pl, 0.2, 19.3) ; 

H16P1V4  =  add_vertex(H16Pl,0.0,19.3); 
H16P2s:add_pg(H16,3.875,0,l)  ; 

H16P2V1  =  add_vertex(H16P2,0.0,0.0); 

H16P2V2  =  add_vertex(H16P2,0.2,0.0) ; 

H16P2V3  =  add_Vfertex(H16P2, 0.2,19.3) ; 

H16P2V4  =  add_vertex(H16P2, 0.0, 19.3) ; 
add_edge(H16PlVl,H16P2Vl) ; 
add_edge(H16PlV2,H16P2V2) ; 
add_edge{H16PlV3,H16P2V3) ; 
add_edge(H16PlV4,H16P2V4) ; 
add_ceiling(H16Pl,H16P2) ; 

add_instance ( “moldinglO  * , 9 , H16 , 0 . 0 , 1562 .0,0. 0,0. 0,0. 0,0.0) 

H17=add_ph ( ■moldingll ‘  9, W, 1 , 1 ) ; 

H17Pl=add_pg(H17, 0.0, 1, 1) ; 

H17P1V1  =  add_vertex(H17Pl,0.0,0.0) ; 

H17P1V2  =  add_vertex(Hl7Pl,0.2,0.0); 

H17P1V3  =  add_vertex(H17Pl, 0.2, 31.4) ; 

H17P1V4  =  add_vertex(H17Pl,0.0,31.4); 
H17P2=add_pg(H17.3.875,0,l) ; 

H17P2V1  s  add_v€rrtex(H17P2,0.0,0.0)  ; 

H17P2V2  s  add_vertex(H17p2,0.2,0.0); 

H17P2V3  *  add_vertex(H17p2, 0.2, 31.4) ; 

H17P2V4  s  add_vertex{H17P2,0.0,31.4) ; 
add_edge (H17P1V1 , H17P2V1 ) ; 
add_edge(H17PlV2,H17P2V2) ; 
add_edge(H17PlV3,H17P2V3) ; 
add_edge(H17PlV4,H17p2V4); 
add_ceiling(H17Pl,H17P2) ; 

add_instance ( ’moldingll* , 9, H17, 0 . 0, 1619 . 0, 0.0, 0.0, 0.0, 0.0) 

H18=add_ph(’moldingl2’,9,W, 1,1) ; 
H18Pl=add_pg(H18,0.0,l,l) ; 

H18P1V1  s  add_vertex(H18Pl,0.0,0.0) ; 

H18P1V2  =  add_vertex{H18Pl,0.2,0.0) ; 

H18P1V3  =  add_vertex(H18Pl, 0.2, 68.0) ; 

H18P1V4  *  add_vertex{H18Pl,0.0,68.0); 
H18P2sadd_pg(H18,-3.875,0,l)  ; 

H18P2V1  »  add_vertex(H18P2,0.0,0.0)  ; 

H18P2V2  »  add_vertex(H18P2,0.2,0.0); 

H18P2V3  =  add_vertex(H18P2, 0.2,68.0); 
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H18P2V4  »  add_vert«x(H18P2. 0.0, 68.0) ; 
add_edg«(H18PlVl,H18P2Vl) ; 
add_edg« ( H 1 8  PI V2 . HI 8  P2V2 ) ; 
add_adge (H18P1V3 , H18P2V3 ) ; 
add_edge(H18PlV4.H18P2V4) ; 
add_ceiling(H18Pl.H18P2) ; 

add_instance(  ''inoldingl2* ,  9,  H18,  0.0, 1684.5,  0.0,0.0,0.0,0.0); 

H19xadd_ph(  *inoldingl3* ,  9,W,  1, 1) ; 

H19Plxaddj?g(H19,0.0,l,l) ; 

H19P1V1  X  add_vertex(H19Pl,0.0,0.0) ; 

H19P1V2  X  add_vertax(H19Pl,0.2,0.0); 

H19P1V3  X  add_vertex(H19Pl, 0.2,46.2) ; 

H19P1V4  X  add_vertex(H19Pl,0.0,46.2); 

H19P2xadd_pg(H19, 3.875,  0,1)  ,- 
H19P2V1  X  add_vertex(H19P2, 0.0, 0.0) ; 

H19P2V2  X  add_vertex(H19P2,0.2,0.0) ; 

H19P2V3  X  add_vertex(H19P2, 0.2, 46.2) ; 

H19P2V4  X  add_vertex(H19P2,0.0,46.2)  ,- 
add_edge(H19PlVl,H19P2Vl) ; 
add_edge(H19PlV2,H19P2V2) ; 
add_edge(H19PlV3,H19P2V3) ; 
add_edge(H19PlV4,H19P2V4) ; 
add_ceiling(H19Pl,H19P2) ; 

add_instance ( •inoldingl3  * , 9, H19, 0.0, 1788.2, 0.0, 0.0, 0.0, 0.0) ; 

H20xadd_ph{  •inoldingl4  * ,  9,  W,  1, 1) ; 

H20Pl=add_pg(H20,0.0,l,l) ; 

H20P1V1  X  add_vertex(H20Pl,0.0,0.0) ; 

H20P1V2  X  add_vertex(H20Pl,0.2,0.0) ; 

H20P1V3  X  add_vertex(H20Pl,0.2,43.0) ; 

H20P1V4  =  add_vertex(H20Pl,0.0,43.0) ; 

H20P2=add_pg(H20,3.875,  0,1)  ; 

H20P2V1  X  add_vertex(H20P2,0.0,0.0) ; 

H20P2V2  X  add_vertex(H20P2,0.2,0.0) ; 

H20P2V3  X  add_vertex(H20P2, 0.2,43.0) ; 

H20P2V4  X  add_vertex(H20P2,0.0,43.0); 
add_edge(H20PlVl,H20P2Vl) ; 
add_edge(H20PlV2,H20P2V2) ; 
add_edge (H20P1V3 , H20P2V3 ) ; 
add_edge(H20PlV4,H20P2V4) ; 
add_ceiling(H20Pl,H20P2) ; 

add_instance( ■moldingl4* , 9,H20, 0.0, 1874.1,0.0,0.0, 0 .0, 0 .0) ; 

H21xadd_ph( 'moldinglS' , 9, W, 1, 1) ; 

H21Pl=add_pg(H21,0.0,l,l) ; 

H21P1V1  X  add_vertex{H21Pl,0.0,0.0) ; 

H21P1V2  X  add_vertex(H21Pl,0.2,0.0) ; 
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H21P1V3  =  ad(L.v«rtex(H21Pl,0.2,-i.6) ; 

H21P1V4  s  add«v*rtex(H21Pl,0.0,71.6); 

H21P2=add_psr(H21,  3.875, 0,1)  ; 

H21P2V1  X  add_vart«x{H21P2,0.0,0.0) ; 

H21P2V2  X  add_v®rt«x(H21P2.0.2,0.0) ; 

H21P2V3  X  add_vert«x(H21P2, 0.2,71.6) ; 

H21P2V4  X  add_v*rt«x(H21P2.0.0.71,6) : 
add_edge(H21PlVl,H21P2Vl) ; 
add_*dge (H21P1V2 , H21P2V2 ) ; 
add_edge (H21P1V3 , H21P2V3 ) ; 
add_edge ( H2 1 PI V4 , H2 1 P2 V4 ) ; 
add_ceiling(H21Pl.H21P2) ; 

add_in8tance( 'moldinglS* , 9,H21, 0. 0, 1956. 8, 0.0, 0.0, 0.0, 0.0); 

H22  xadd_ph (•moldingl6*,9,W,l,l); 

H22Pl=add_pg(H22,0.0,l,l) ; 

H22P1V1  X  add_vertex(H22Pl,0.0,0.0) ; 

H22P1V2  X  add_vertex(H22Pl,0.2,0.0); 

H22P1V3  X  add_vertex(H22Pl, 0.2, 125.0) ; 

H22P1V4  X  add_vertex (H22P1, 0.0, 125.0) ; 

H22P2xadd_pg(H22, 3.875, 0, 1) ; 

H22P2V1  X  add_vertex(H22P2,0.0,0.0) ; 

H22P2V2  X  add_vertex(H22P2,0.2,0.0) ; 

H22P2V3  X  add_vertex(H22P2, 0.2, 125.0) ; 

H22P2V4  X  add_vertex(H22P2, 0.0, 125.0); 
add.edge (H22P1V1 , H22P2V1 ) ; 
add_edge(H22PlV2,H22P2V2) ; 
add_edge (H22P1V3 , H22P2V3 )  ; 
add_edge (H22P1V4 , H22P2V4 ) ; 
add_ceiling(H22Pl,H22P2)  ; 

add_instance ( ’nroldingie* , 9 , H22, 0 .0, 2068 .1, 0 . 0, 0 . 0, 0 . 0,  0 .0) ; 

H23=add_ph(*inolding9*,  8,W,1,1); 

H23Pl=add_pg(H23,0.0,l,l) ; 

H23P1V1  X  add_vertex(H23Pl,0.0,0.0); 

H23P1V2  X  add_vertex(H23Pl,0.2,0.0); 

H23P1V3  X  cdd_vertex(H23Pl,0.2,19.0) ; 

H23P1V4  X  add_vertex(H23Pl,0.0,19.0); 
H23P2=add_pg(H23,3.875,0,l) ; 

H23P2V1  X  add_vertex(H23P2,0.0,0.0) ; 

H23P2V2  X  add_vertex{H23P2,0.2,0.0) 

H23P2V3  X  add_vertex(H23P2,  0.2, 19.0;  ; 

H23P2V4  X  add_vertex(H23P2,0.0,19.0) ; 
addLedge ( H2  3  PlVl , H2  3  P2 VI )  ; 
add_edge ( H2  3  P1V2 , H2  3  P2V2 ) ; 
add_«dge (H23P1V3 , H23P2V3 ) ; 
add_edge ( H2  3  PI V4 , H2  3  P2 V4 ) ; 
add_ceiling(H23Pl,H23P2) ; 
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add_instance ( ‘moldinglC* , 9 , H23 , 0 .0, 2232 .8, 0. 0,0. 0,0. 0,0.0) ; 

H24=add_ph ( 'moldingl? • ,9,W,1,1); 

H24Pl=add_pg{H24,0.0,l,l) ; 

H24P1V1  =  add_vertex(H24Pl, 0.0, 0.0)  ; 

H24P1V2  =  add_vertex(H24Pl,0.2,0.0); 

H24P1V3  =  add_vartax(H24Pl, 0.2, 61.7); 

H24P1V4  X  add_vertex{H24Pl, 0.0,61.7) ; 

H2  4  P2 =add_pg { H2  4 . 3 . 87  5 , 0 , 1 ) ; 

H24P2V1  X  add_vertex(H24P2,0.0,0.0); 

H24P2V2  X  add_vcrt«x(H24P2,0.2,0.0); 

H24P2V3  -  add_vert«x(H24P2, 0.2, 61.7) ; 

H24P2V4  X  add_vertex(H24P2, 0.0, 61.7); 
add_edge(H24PlVl,H24P2Vl) ; 
add_edge(H24PlV2,H24P2V2) ; 
add_edge {H24P1V3 , H24P2V3 ) ; 
add_edge(H24PlV4,H24P2V4) ; 
add_ceiling(H24Pl,H24P2) ; 

add_instance ( •moldingl7 • , 9, H24, 0 .0,2289 . 5, 0.0, 0.0, 0.0, 0.0); 

H25=add_ph ( •moldingl8 • , 9 ,  W,  1 , 1 )  ; 

H25Plxadd_pg(H25,  0  .0, 1, 1)  ; 

H25P1V1  X  add_vertex(H25Pl,0.0,0.0) ; 

H25P1V2  X  add_vertex(H25Pl, 0.0, 177.3) ; 

H25P1V3  X  add_vertex(H25Pl, -0.2, 177.3) ; 

H25P1V4  X  add_vertex(H25Pl.-0.2,0.0); 
H25P2xadd_pg(H25,3.875,0,l)  ; 

H25P2V1  X  add_vertex(H25P2,0.0,0.0) ; 

H25P2V2  X  add_vertex(H25P2, 0.0, 177.3) ; 

H25P2V3  X  add_vertex(H25P2, -0.2, 177.3) ; 

H25P2V4  X  add_vert''X(H25P2,-0.2,0.0); 
add_edge(H25PlVl,H25P2Vl) ; 
add_«fdge  (H25P1V2 ,  H25P2V2 )  ; 
add_edge(H25PlV3,H25P2V3) ; 
add_edge (H25P1V4 , H25P2V4 ) ; 
add_ceiling(H25Pl,H25P2) ; 

add_instanceCinoldingl8',9,H25,98.0,2173.9,0.0, 0.0, 0.0,  0.0) 

H26xadd_ph  ( ’nioldingl9" ,  9,  W,  1,1); 

H26Plxadd_pg{H26,0.0,l,l) ; 

H26P1V1  X  add_vertex(H26Pl,0.0,0.0) ; 

H26P1V2  X  add_vertex(H26Pl. 0.0, 194.5) ; 

H26P1V3  X  add_vertex(H26Pl, -0.2, 194.5) ; 

H26P1V4  X  add_vertex(H26Pl,-0.2,0.0); 
H26P2=add_pg(H26,3.875,0,l) ; 

H26P2V1  X  add_vertex(H26P2,0.0,0.0) ; 

H26P2V2  X  add_vertax(H26P2, 0.0, 194.5); 

H26P2V3  X  add_vertex(H26P2, -0.2, 194.5); 

H26P2V4  X  add_vertex{H26P2.-0.2,0.0); 
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add_edge(H26PlVl,H26P2Vl) ; 
add_edge (H26P1V2 , H26P2V2 ) ; 
add_edge (H26P1V3 , H26P2V3 ) ; 
add_edge (H26P1V4 , H26P2V4 ) ; 
add_ceiling(H26Pl.H26P2) ; 

add_instance( "moldinglS" , 9,H26,98.0,1939.7,0.0,0.0,0.0,0.0); 


H27=add_phCinolding20‘,9,W.  1, 1) ; 

H27Pl=add_pg{H27,0.0,l,l) ; 

H27pm  =  add_vertex(H27Pl,0.0.0.0)  ; 

H27P1V2  =  add_vertex(H27Pl. 0.0, 129.2); 

H27P1V3  =  add_vertex(H27Pl, -0.2, 129.2) ; 

H27P1V4  =  add_vertex(H27Pl,-0.2,0.0): 
H27P2=add_pg(H27,3.875,0,l) ; 

H27P2V1  =  add_vertex(H27P2,0.0,0.0) ; 

H27P2V2  =  add_vertex(H27P2, 0.0, 129.2) ; 

H27P2V3  =  add_vertex(H27p2, -0.2, 129.2); 

H27P2V4  =  add_vertex(H27P2.-0.2,0.0)  ; 
add_edge(H27PlVl,H27P2Vl) ; 
add_edge(H27PlV2,H27P2V2) ; 
add_edge (H27P1V3 . H27P2V3 ) ; 
add_edge (H27P1V4 , H27P2V4 ) ; 
add_ceiling(H27Pl,H27P2) ; 

add_instance ( *molding20“ , 9, H27 ,98.0,1746.5,0.0,0.0,0.0,0.0)  ; 

H28=add_ph(  •inolding21* ,  9,W,1,1); 

H28Pl=add_pg(H28,0.0,l,l) ; 

H28P1V1  =  add_vertextH28Pl,0.0,0.0) ; 

H28P1V2  =  add_vertex(H28Pl,0.0,158.1) ; 

H28P1V3  =  add_vertex(H28Pl,-0.2,158.1) ; 

H28P1V4  =  add_vertex(H28Pl,-0.2,0.0); 

H28P2=add_pg(H28, 3.875,  0,1); 

H28P2V1  =  add_vertex(H28P2,0.0,0.0) ; 

H28P2V2  =  add_vertex(H28P2,0,0,158.1) ; 

H28P2V3  =  add_vertex(H28P2, -0.2, 158.1) ; 

H28P2V4  =  add_vertex(H28P2, -0.2, 0.0) ; 
add_edge (H28P1V1 , H28P2V1 ) ; 
add_edge (H28P1V2 , H28P2V2 ) ; 
add_edge (H28P1V3 , H28P2V3 ) ; 
add_edge (H28P1V4 , H28P2V4 ) ; 
add_ceiling{H28Pl,H28P2) ; 

add_instance ( ■inolding21" , 9,H28, 98 .0, 1524.4,  0.0,0.0,0.0,0.0); 

H29=add_ph(  ‘inolding22* ,  9,W,  1,1); 

H29Pl=add_pg(H29,0.0,l,l) ; 

H29P1V1  =  add_vertex(H29Pl,0.0,0.0) ; 

H29P1V2  =  add_vertex(H29Pl, 0.0,115.7); 
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H29P1V3  «  add_v«rt«x(H29Pl. -0.2, 115.7); 

H29P1V4  *  add_v«rt«x(H29Pl.-0.2.0.0) ; 
H29P2«add_pg(H29,3.875,0.1)  ; 

H29P2V1  a  add_vertex(H29P2,0.0.0.0) ; 

H29P2V2  X  add_vertax(H29P2,0.0.1l5.7) ; 

H29P2V3  X  add_vertax(H29P2. -0.2, 115.7) ; 

H29P2V4  X  add_vartax(H29P2,-0.2,0.0) ; 
add_edge(H29PlVl,H29P2Vl) ; 
add_adge ( H2  9  PI V2 . H2  9  P2 V2 ) ; 
add_adge (H29P1V3, H29P2V3 ) ; 
add_adge (H29P1V4 , H29P2V4 ) ; 
add_cailing(H29Pl,H29P2) ; 

add_instance("inolding22*.9,H29.98.0,1344.7,0.0,0.0,0.0,0.0) 

H3  0xadd_ph ( •molding23 ’ . 9 , W. 1 , 1 ) ; 

H30Plxadd_pg(H30,  0.0, 1, 1)  ; 

H30P1V1  X  add_vertex(H30P1.0.0.0.0) : 

H30P1V2  X  add_v«rtex(H30Pl, 0.0, 184.2) ; 

H30P1V3  X  add_vertex(H30Pl, -0.2, 184.2) ; 

H30P1V4  X  add_vertex(H30Pl,-0.2,0.0); 

H30P2xadd_pg(H30, 3.875, 0,1)  ; 

H30P2V1  X  add_vertex(H30P2,0.0,0.0) ; 

H30P2V2  X  add_vertex(H30P2, 0.0, 184,2) ; 

H30P2V3  X  add_vertex(H30P2, -0.2, 184.2)  ; 

H30P2V4  X  add_vertex{H30P2,-0.2,0.0); 
add_edge(H30PlVl,H30P2Vl) ; 
add_edge(H30PlV2,H30P2V2) ; 
add_edge(H30PlV3,H30P2V3) ; 
add_edge(H30PlV4,H30P2V4) ; 
add_ceiling(H30Pl,H30P2)  ; 

add_instance{  •inolding23* ,  9,  H30, 98 .0, 1120 . 8, 0 . 0,  0. 0,0. 0,0.0), • 

H46xadd_ph(  "inolding24" ,  9,  W,  1, 1 ) ; 

H46Plxadd_pg(H46,0.0,l,l) ; 

H46P1V1  X  add_vertex(H46Pl, 0.0, 0.0) ; 

H46P1V2  X  add_vertex(H46Pl, 0.0,202.0) ; 

H46P1V3  X  add_vertex(H46Pl,-0.2,202.0) ; 

H46P1V4  X  add_vertex(H46Pl,-0.2,0.0); 

H46P2xadd_pg(H46, 3.875, 0,1) ; 

H46P2V1  X  add_vertex(H46P2,0.0,0.0) ; 

H46P2V2  X  add_vertex(H46P2,0.0,202.0) ; 

H46P2V3  X  add_vertex(H46P2, -0.2, 202.0) ; 

H46P2V4  X  add_vertex(H46P2,-0.2,0.0) ; 
add_edge(H46PlVl,H46P2Vl) ; 
add_edge(H46PlV2,H46P2V2) ; 
add^adge (H46P1V3 , H46P2V3 ) ; 
add_edge (H46P1V4 , H46P2V4 ) ; 
add_ceiling(H46Pl,H46P2) ; 
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ad4_instance  ( *inolding24  * ,  9 ,  H46 , 98 . 0 , 877 .1,0.0, 0.0, 0.0, 0.0) 


H31=add_ph('n»olding25"  ,9,W,  1,1)  ; 
H31Pl=add_pg(H31,0.0,l,l) ; 

H31P1V1  =  add_vert«x(H31Pl,0.0.0.0); 

H31P1V2  »  add_vertex (H31P1,  0.0, 32.0); 

H31P1V3  =  add_vertex(H31Pl, -0.2, 32.0); 

H31P1V4  =  add_vertex(H31Pl,-0.2,0.C); 
H31P2=add_pg(H31,3.875,0,l) ; 

H31P2V1  =  add_vertex(H31P2,0.0,0.0); 

H31P2V2  =  add_vertex{H31P2, 0.0, 32.0) ; 

H31P2V3  =  add_vertex(H31P2, -0.2, 32.0); 

H31P2V4  *  add_vertex(H31P2, -0.2,0.0) ; 
add_edge (H3 IPIVI , H3 1P2V1 ) ; 
add_edge(H31PlV2,H31P2V2) ; 
add_edge(H31PlV3,H31P2V3) ; 
add_edge(H31PlV4,H31P2V4)  ; 
add_ceiling(H31Pl,H31P2)  ; 

add_instance ( •molding25  * , 9, H3 1,98. 0,798. 1,0. 0,0. 0,0. 0,0.0) 

H32=add_ph( ■molding26* ,9,W,1,1); 
H32Pl=add_pg(H32,0.0,l,l) ; 

H32P1V1  =  add_vertex(H32Pl,0.0,0.0) ; 

H32P1V2  =  add_vertex(H32Pl, 0.0, 191.9); 

H32P1V3  =  add_vertex(H32Pl, -0.2, 191.9); 

H32P1V4  =  add_vertex(H32Pl,-0.2,0.0); 
H32P2=add_pg(H32,3.875,0,l) ; 

H32P2V1  =  add_vertex(H32P2,0.0,0.0); 

H32P2V2  =  add_vertex(H32P2, 0.0, 191.9)  ; 

H32P2V3  =  add_vertex(H32P2, -0.2, 191.9) ; 

H32P2V4  =  add_vertex(H32P2, -0.2,0.0)  ; 
add_edge(H32PlVl,H32P2Vl) ; 
add_edge(H32PlV2,H32P2V2) ; 
add_edge (H32P1V3 , H32P2V3 ) ; 
add_edge (H32P1V4, H32P2V4) ; 
add_ceiling(H32Pl,H32P2) ; 

add_instance( *inolding26* , 9, H32, 98.0, 566.5,  0.0, 0.0,  0.0, 0.0) 

H33=add_ph{'inolding27',9,W,l,l); 
H33Pl=add_pg(H33,0.0,l,l) ; 

H33P1V1  =  add_vertex(H33Pl,0.0,0.0) ; 

H33P1V2  s  add_vertex(H33Pl, 0.0, 112.9); 

H33P1V3  =  add_vertex{H33Pl, -0.2, 112.9) ; 

H33P1V4  =  add_vert«x(H33Pl,-0.2,0.0); 
H33P2=add_pg(H33,3.875,0, 1) ; 

H33P2V1  =  add_vertex(H33P2,0.0,0.0) ; 

H33P2V2  =  add_vertex(H33P2, 0.0, 112.9); 

H33P2V3  a  add_vertex(H33P2, -0.2,112.9); 
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H33P2V4  »  add_v*rt«x(H33P2. -0.2. 0.0) ; 
add_«dge'H33PlVl,H33P2Vl) ; 
add_edge ( H3  3  P1V2 , H3  3  P2 V2 ) ; 
add_«dge ( H3  3  P1V3 , H3  3  P2V3 ) ; 
add_adge ( H3  3  P1V4 . H3  3  P2V4 ) ; 
add^ceiling(H33Pl,H33P2) ; 

add_in8tanca(*inolding27* , 9,H33. 98, 0,413.9,0.0,0.0,0.0,0.0); 

H34=add_ph{*inolding28*,9,W,  1,1) ; 

H34Pl=addj)g(H34,0.0.1.1)  ; 

H34P1V1  =  add_vertex{H34Pl,0.0,0.0) ; 

H34P1V2  =  add_v«rt«x(H34Pl,0.0.-0.2) ; 

H34P1V3  =  add_vertex(H34Pl, 157.9,-0.2) ; 

H34P1V4  =  add_v«rtex(H34P1.157.9.0.0) ; 
H34P2»add_pg(H34.3.875,0. 1) ; 

H34P2V1  =  add_vertex(H34P2.0.0.0.0) ; 

H34P2V2  =  add_vertex(H34P2,0.0.-0.2) ; 

H34P2V3  =  add_vertex(H34P2.157.9.-0.2) ; 

H34P2V4  =  add_vertex (H34P2, 157. 9,0.0 ); 
add_edge(H34PlVl,H34P2Vl) ; 
add_edge{H34PlV2,H34P2V2) ; 
add_edge(H34PlV3,H34P2V3) ; 
add_edge(H34PlV4,H34P2V4) ; 
add_ceiling(H34Pl,H34P2)  ; 

add_instance( *inolding28* , 9, H34, 98 .0, 413 .9, 0.0,0.0,0.0,0.0); 

H35=add_ph(  •it>olding29* ,  9,  W,  1,1); 

H35Pl=add_pg{H35,0.0,l,l) ; 

H35P1V1  =  add_vertex(H35Pl,0.0,0.0) ; 

H35P1V2  =  add_vertex(H35Pl, 0.0,-0.2) ; 

H35P1V3  =  add_vertex(H35Pl,41.6,-0.2) ; 

H35P1V4  =  add_vertex(H35Pl,41.6,0.0)  ; 
H35P2=add_pg(H35,3.875,0, 1)  ; 

H35P2V1  =  add_vertex(H35P2,0.0,0.0) ; 

H35P2V2  =  add_vertex(H35P2, 0.0, -0.2) ; 

H35P2V3  =  add_vertex(H35P2,41.6.-0.2); 

H35P2V4  =  add_vertex(H35P2,41.6,0.0); 
add_edge(H35PlVl,H35P2Vl) ; 
add_edge (H3  5P1V2 , H3  5P2V2 ) ; 
add_edge (H35P1V3 , H35P2V3 ) ; 
add_edge(H35PlV4,H35P2V4) ; 
add_ceiling(H35Pl,H33P2) ; 

add_instance( •inolding29* , 9,H35,295.9, 413 .9, 0.0,0.0,0.0,0.0); 

H36=add_ph(*Tnolding30’,9,W,l,l) ; 

H36Pl=ad<i_pg(H36,  0.0, 1, 1)  ; 

H36P1V1  s  add_vertex(H36Pl,0.0,0.0) ; 

H36P1V2  =  add_vertex(H36Pl,-0.2,0.0) ; 


84 


H36P1V3  =  add_vert«x(H36Pl, -0.2.9.3) ; 

H36P1V4  X  adcLv«rt«x(H36Pl,0.0.9.3); 
H36P2xadd_pg(H36,3.875, 0, 1) ; 

H36P2V1  X  add_vertex(H36P2.0.0,0.0); 

H36P2V2  =  add_vertex(H36P2,-0.2.0.0)  ; 

H36P2V3  X  add_vertex(H36P2, -0.2.9.3) ; 

H36P2V4  X  add_vertex(H36P2.0.0.9.3); 
add_«dge(H36PlVl,H36P2Vl) ; 
add_edge(H36PlV2.H36P2V2) ; 
add_edge (H36P1V3 , H36P2V3 ) ; 
add_edge(H36PlV4,H36P2V4) ; 
add_ceiling(H36Pl,H36P2) ; 

add_instance( "moldings O" , 9, H3 6, 337.5,404 . 6, 0.0, 0.0, 0.0, 0.0); 

H37  xadd_ph ( "moldingS 1",9,W,1,1); 

H37Pl=add_pg(H37.0.0,l,l) ; 

H37P1V1  X  add_vertex(H37Pl,0.0,0.0) ; 

H37P1V2  X  add_vertex(H37Pl,-0.2,0.0) ; 

H37P1V3  X  add_vertex(H37Pl, -0.2,28.4) ; 

H37P1V4  X  add_vertex(H37Pl,0.0,28.4); 
H37P2xadd_pg(H37,3.875,  0, 1)  ; 

H37P2V1  X  add_vertex(H37P2,0.0,0.0); 

H37P2V2  X  add_vertex(H37P2,-0.2,0.0) ; 

H37P2V3  X  add_vertex(H37P2, -0.2,28.4) ; 

H37P2V4  X  add_vertex(H37P2, 0.0,28.4) ; 
add_edge(H37PlVl,H37P2Vl) ; 
add_edge(H37PlV2,H37P2V2); 
add_edge(H37PlV3,H37P2V3) ; 
add_edge(H37PlV4,H37P2V4) ; 
add_ceiling{H37pl,H37P2) ; 

add_instance ( "molding! 1" , 9, H37, 337. 5, 3 12. 2, 0.0, 0.0, 0.0, 0.0); 

H3  8=add_ph ( 'molding32 " ,9,W,1,1); 

H38Plxadd_pg(H38,0.0,l,l) ; 

H38P1V1  X  add_vertex(H38Pl, 0.0,0.0) ; 

H36P1V2  X  add_vertex(H38Pl,-0.2,0.0); 

H38P1V3  X  add_vertex(H38Pl,-0.2,5.1) ; 

H38P1V4  X  add_vertex(H38Pl,0.0,5.1); 

H38P2xadd_pg(H38, 3.875, 0,1) ; 

H38P2V1  X  add_vertex(H38P2,0.0,0.0); 

H38P2V2  X  add_vertex(H38P2,-0.2,0.0) ; 

H38P2V3  X  add_vertex(H38P2,-0.2,5.1) ; 

H38P2V4  X  add_vertex{H38P2,0.0,5.1); 
add_edge (H38P1V1 , H38P2V1 ) ; 
add_edge (H38P1V2 , H38P2V2 ) ; 
add_edge (H38P1V3 , H38P2V3 ) ; 
add_edge(H38PlV4,H38P2V4) ; 
add_ceiling(H38Pl,H38P2) ; 


add_instanc«  ( ■molding32 ' . 9,  H38. 3  3*7. 5, 267. 4, 0.0, 0.0, 0.0, 0.0); 

H39sadd_ph  ( ■inolding33  *  ,9,W,1,1); 

H39Pl«add_pg(H39,0.0,l,l)  ; 

H39P1V1  »  add_v«rtex(H39Pl, 0.0,0.0) ; 

H39P1V2  »  add_vertax(H39Pl,30.6,0.0) ; 

H39P1V3  =  add_vartax(H39Pl,30.6,0.2) ; 

H39P1V4  =  add_vart«x(H39Pl,0.0,0.2); 

H39P2=add_pg{H39, 3.875, 0,1) ; 

H39P2V1  »  add_vertex(H39P2,0.0,0.0); 

H39P2V2  =  add_vartex(H39P2,30.6,0.0); 

H39P2V3  =  add_vertex(H39P2, 30. 6,0.2); 

H39P2V4  =  add_vertex(H39P2,0.0,0.2); 
add_edge(H39PlVl,H39P2Vl); 
add_adge(H39PlV2,H39P2V2) ; 
add_edge (H39P1V3 , H39P2V3 » ; 
add_edge{H39PlV4,H39P2V4) ; 
add_ceiling(H39Pl,H39P2) ; 

add_instance( 'moldinglS* , 9, H39, 306 .9, 267 .4, 0. 0,0. 0,0. 0,0.0) ; 

H40=add_ph(  •inolding34* ,  9 ,  W,  1, 1) ; 

H40Pl=add_pg(H40,0.0,l,l) ; 

H40P1V1  =  add_vertex(H40Pl,0.0,0.0); 

H40P1V2  =  add_vertex(H40Pl, 56.7, 0.0) ; 

H40P1V3  =  add_vertex(H40Pl, 56.7, 0.2) ; 

H40P1V4  =  add_vertex(H40Pl,0.0,0.2); 

H40P2=add_pg(H40, 3.875, 0, 1) ; 

H40P2V1  =  add_vertex(H40P2. 0.0, 0.0) ; 

H40P2V2  =  add_vertex(H40P2, 56. 7,0.0); 

H40P2V3  »  add_vertex(H40P2, 56. 7,0.2) ; 

H40P2V4  =  add_vertex(H40P2, 0.0, 0.2) ; 
add_edge(H40PlVl,H40P2Vl) ; 
add_edge(H40PlV2,H40P2V2) ; 
add_edge(H40PlV3,H40P2V3) ; 
add_edge(H40PlV4.H40P2V4) ; 
add_ceiling(H40Pl,H40P2) ; 

add_instance ( "inolding34’ , 9,H40, 192.2,267.4, 0.0,0.0,0.0,0.0); 

H41=add_ph{  •inolding35‘ ,  9,  W,  1, 1)  ; 

H41Pl=add_pg{H41,0.0,l,l)  ; 

H41P1V1  *  add_vertex(H41Pl,0.0,0.0) ; 

H41P1V2  =  add_vertex(H41Pl, 36.2, 0.0) ; 

H41P1V3  =  add_vertex(H41Pl, 36.2, 0.2) ; 

H41P1V4  =  add_vertex(H41Pl,0.0,0.2) ; 
H41P2=add_pg(H41,3.875,0,l) ; 

H41P2V1  s  add_vertax(H41P2,0.0,0.0) ; 

H41P2V2  =  add_vertex(H41P2, 36.2, 0.0) ; 

H41P2V3  =  add_vertex(H41P2, 36.2, 0.2) ; 

H41P2V4  =  add_vertex(H41P2,0.0,0.2) ; 
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adQL«dg«(H41PlVl,H41P2Vl) ; 
add_*dge(H41PlV2,H41P2V2) ; 
add_edge (H41P1V3 , H41P2V3 ) ; 
add_«dge (H41P1V4, H41P2V4) ; 
add_cailing(H41Pl, H41P2) ; 

add_instance ( *inoIding35* , 9, H41, 98 .0,267.4, 0.0,0.0,0.0,0.0); 

H42=add_ph(*molding36*,9,W,l,l) ; 

H42Pl=add_pg(H42,0.0,l,l)  ; 

H42P1V1  =  add_vertex(H42Pl,0.0,0.0); 

H42P1V2  »  add_vertex{H42Pl,0.0,-0.2) ; 

H42P1V3  =  ad<J_vertex(H42Pl,  165.4, -0.2); 

H42P1V4  =  add_vertex(H42P1.165.4,0.0); 

H42P2=add_pg(H42, 3.875, 0,1) ; 

H42P2V1  =  add_vertex(H42P2.0.0,0.0) ; 

H42P2V2  s  add_vartex(H42P2, 0.0, -0.2) ; 

H42P2V3  s  add ,vertex(H42P2, 165.4, -0.2) ; 

H42P2V4  =  add_vertex (H42P2, 165. 4,0.0 ); 
add_edge (H42P1V1 , H42P2V1 ) ; 
add_edge(H42PlV2,H42P2V2) ; 
add_«dge (H42P1V3 , H42P2V3 ) ; 
add_edge(H42PlV4,H42P2V4) ; 
add_ceiling(H42Pl,H42P2) ; 

add_instance ( •molding36* , 9, H42, 98.0,102.0,0.0,0.0,0.0,0.0)  ; 

H43sadd_ph("n>olding37*,9,W,  1,1); 
H43Pl*add_pg(H43,0.0,l,l); 

H43P1V1  =  add_vertex{H43Pl,0.0,0.0) ; 

H43P1V2  =  add_vertex(H43Pl,-0.2,0.0) ; 

H43P1V3  =  add_vertex(H43Pl, -0.2, 62.3); 

H43P1V4  =  add_vertex(H43Pl,0.0,62.3); 
H43P2=add_pg(H43,3.875, 0, 1) ; 

H43P2V1  =  add_vertex(H43P2, 0.0, 0.0) ; 

H43P2V2  =  add_vertex(H43P2, -0.2, 0.0) ; 

H43P2V3  =  add_vertex(H43P2, -0.2, 62.3) ; 

H43P2V4  =  add_vertex(H43P2, 0.0, 62.3) ; 
add_edge(H43PlVl,H43P2Vl) ; 
add_edge(H43PlV2,H43P2V2) ; 
add_edge (H43P1V3 , H43P2V3 ) ; 
add_edge(H43PlV4,H43P2V4) ; 
add_ceiling(H43Pl,H43P2) ; 

add_instance ( ■inolding37’ , 9, H43 ,98.0,0.0,0.0,0.0,0.0,0.0)  ; 

H44=add_ph( •electric_panel* , 14,W, 1, 1) ; 
H44Plsad4_pg(H44,0.0,l,l) ; 

H44PlVl=add_vertex (H44P1 ,0.0,0.0); 

H44PlV2=add_vertex (H44P1 ,0.0,47.0); 
H44PlV3=add_vertex(H44Pl, -0.2,47.0) ; 
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H44PlV4=add_v«rt«x{H44Pl, -0.2,0.0) ; 

H44P2-add_pg(H44. 86.0, 0.1) ; 

H44P2Vlsadd_vertex(H44P2, 0.0, 0.0) ; 

H44P2V2=add_v«rt«x (H44P2 .0.0,47.0); 

H44P2V3*add_vertex{H44P2, -0.2,47.0) ; 

H44P2V4=add_vertax(H44P2, -0.2.0.0) ; 
add_edge {H44P1V1 , H44P2V1 ) ; 
add_edge(H44PlV2.H44P2V2) ; 
add_edg« (H44P1V3 , H44P2V3 ) ; 
add.edge (H44P1V4, H44P2V4 ) ; 
add_ceiling(H44Pl,H44P2) ; 

add_instance ( "electric_panell’ , 1 5, H44, 98.0, 830.1, 0.0,0.0,0.0,0.0); 

H45=add_ph(  •rooin_label’ ,  10,W,1,1); 

H45Pl=add_pg(H45.57,6.1,l) ; 

H45PlVl=add_vertex{H45Pl,  O.O.O.O) ; 

H45PlV2=add_vertex (H45P1 ,0.0,7.0); 

H45PlV3=add_vertex(H45Pl, -0.2.7.0) ; 

H45PlV4=add_vertex(H45Pl.  -0.2.0.0)  ; 

H45P2=!add_pg(H45,  64,6,0,1)  ; 

H45P2Vl=add_vertex (H45P2 .O.O.O.O); 

H45P2V2=add_vertex(H45P2, 0.0,7.0) ; 

H45P2V3=add_vertex(H45P2, -0,2,7.0) ; 

H45P2V4=add_vertex(H45P2, -0.2, 0.0) ; 
add_edge(H45PlVl,H45P2Vl) ; 
add_edge(H45PlV2,H45P2V2) ; 
add_edge{H45PlV3,H45P2V3) ; 
add.edge {H45P1V4 , H45P2V4 ) ; 
add_ceiling(H45Pl,H45P2) ; 

add_instance ( *of f ice_label* , 12, H4 5, 337, 5, 331. 1,0. 0,0. 0,0. 0,0.0) ; 
add_instance ( *  511_label * , 9, H45, 337. 5, 314. 9, 0.0, 0.0, 0.0, 0.0); 

H47=add_ph( *elevator_control ■ , 16, W, 1,1); 

H47 PI =add_pg (H47, 42. 0,1,1)  ; 

H47PlVl=add_vertex {H47P1 .O.O.O.O); 
H47PlV2=add_vertex(H47Pl,7.0,0.0) ; 

H47PlV3=add_vertex(H47Pl,7.0,  0.2) ; 

H47PlV4=add_vertex (H47P1 ,0.0,0.2); 

H47P2=add_pg(H47, 64.6, 0,1) ; 

H47P2Vl=add_vertex ( H47P2  .O.O.O.O); 

H47P2V2=add_vertex (H47P2 ,7.0,0.0); 
H47P2V3=add_vertex{H47P2,7.0,0.2); 

H47P2V4=add_vertex (H47P2 , 0 . 0 , 0 .2 ) ; 
add_edge (H47P1V1 , H47P2V1 ) ; 
add_edge (H47P1V2 , H47P2V2 ) ; 
add_edge (H47P1V3 , H47P2V3 ) ; 
add_edge (H47P1V4 , H47P2V4 ) ; 
add_ceiling(H47Pl,H47P2) ; 
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add.instanc« ( •elevator_control* , 16, H47,216.9. 267.4,0.0,0.0,0.0,0.0) ; 

H48=add_ph( *bulletin_board‘ , 14,W, 1, 1) ; 

H48Plsadd_pg(H48, 36.5,1,1); 

H48PlVl=add_vertex (H48P1 ,0.0,0.0); 
H48PlV2=add_vertex(H48Pl,0.0,-3.25); 

H48PlV3=add_vertex(H48Pl. 144.1, -3.25) ; 
H48PlV4=add_vertex(H48Pl,144.1,0.0); 

H48P2=add_psr(H48,84.5,0.1)  ; 

H48P2Vl=iadd_vertex(H48P2, 0.0, 0.0)  ; 

H48P2V2=add_vertex{H48P2. 0.0,  -3 .25)  ; 

H48P2V3=add_vertex(H48P2, 144.1, -3.25) ; 

H48P2V4=add_vertex(H48P2, 144.1,0.0)  ; 
add_edge(H48PlVl,H48P2Vl) ; 
add_edge(H48PlV2,H48P2V2) ; 
add_edge  (H48P1V3 ,  H48P2V3 )  .• 
add_edge(H48PlV4,H48P2V4) ; 
add_ceiling(H48Pl,H48P2) ; 

add_instance ( •bulletin_board* , 14, H4 8, 105. 9, 413. 9, 0.0, 0.0, 0.0, 0.0); 
return  W;  /’return  pointer  to  this  entire  world  structure*/ 
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/• 

Lt  J«unes  Stein 


This  file  contains  the  routines  neccessary  to  support  the  projection  of 
our 

2d+  model  world  into  a  2  dimensional  window.  This  view  will  then  be  used 
for 

pattern  matching  against  the  processed  images  extracted  from  the  raw 

ceunera 

data . 

*/ 

#define  CCD  (2. 0/3.0) 

#define  VIEW_ANGLE  300.0 
idefine  NEARCLIP  1.24 
#define  FARCLIP  5000.0 
#define  MAX_X  646.0 

#define  MAX_Y  587.28  /*  changed  fm  587.28  on  29  Jun  93  */ 


typedef  struct  line  { 

double  X1,X2,V1,Y2,Z1,22; 
double  MODEL_X,  MODEL.Y; 
int  CLIP1(6] ,CLIP2[6] ; 
struct  line  *NEXT; 

/*  pattern-matching  parameters  •/ 
char  name [ 2 ] ; 
float  length; 

double  est_pose_orient ,  est_angle_to_image_center ; 

int  sum_img_lines ; 

float  sum_conf,  sum_dist,  sum_scale; 

)  LINE; 


typedef  struct  line_head  { 

int  LINES, VERT_LINES; 

LINE  *LINE_LIST, *VLINE_LIST,  ‘TAIL, *VTAIL; 

)  LINE_HEAD; 


typedef  struct  window  { 

double  XMIN,  XMAX,  YMIN,  YMAX, 
ZMIN,  ZMAX; 

)  WINDOW; 
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/* 


Y 


0 


-X  90 


-90  X 


180 

-y 


NOTE:  convert  angles  and  tenths  degrees  to  rads  for  sin  and  cos  functions 

*/ 


LINE_HEAD  •conduct_visibility_sweep(WORLD*, double, double, double) ; 


float  find_z(PH,V) 

POLYHEDRON  "PH; 
VERTEX  *V; 


POLYGON  *NEXT_PG; 
VERTEX  *NEXT_V ; 
float  Z_VALUE=66.6; 
int  FOUND=0, PG_CNT=0; 


NEXT_PG=  PH - > POLYGON_L I ST ; 
while  (NEXT.PG)  { 

PG_CNT++; 

NEXT_V=NEXT_PG- >VERTEX_LIST ; 
while  (NEXT_V)  { 
if  (NEXT_Vs=V)  { 

Z_VALUE=NEXT_PG - >Z_VALUE ; 
NEXT_V=NULL; 

F0UND=1; 

) 

else  { 

NEXT_V=NEXT_V->NEXT; 

) 

)  /*  end  while  */ 
if  (FOUND==0) 

NEXT_PG=NEXT_PG- >NEXT ; 
else 

NEXT_PG=NULL; 
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)  /•  end  while  */ 
return  (Z_VALUE); 
)  /•  end  £ind_z  */ 


WINDOW  *  cal c_window ( X , Y , 2 , ORIENT . FOCAL_LEN ) 


{ 


double  X.Y. 2, ORIENT. FOCAL_LEN; 
WINDOW  *WIN; 

double  HYP.XMIN.YMIN.ZMIN,  RADS; 


W1N= (WINDOW  *)malloc(sizeof (WINDOW) ) ; 

RADS=VIEW_ANGLE/10 . 0*PI/180 . 0; 

/•printf CXnXnView  angle=  %.21f  (%.21f  rads) * ,VIEW_ANGLE, RADS) ; 
printf CXnXnFocal  lengths  % .21f * .FOCAL_LEN) ; */ 

HYP  =  FOCAL_LEN/cos (RADS/2 .0); 

/•printf CXnXnHyp  len=  %.21£*.HYP) ;*/ 

WIN->XMIN  =  X-cos( (90.0-OR1ENT-VIEW_ANGLE/20.0)*PI/180.0)  * 

HYP; 

WIN->XMAX  =  X-sin( (ORIENT-VIEW_ANGLE/20.0) *PI/180.0)  *  HYP; 
WIN->YMIN  s  Y+sin( (90.0-ORIENT-VIEW_ANGLE/20.0)*PI/180.0)  * 

HYP; 

WIN->YMAX  =  Y+cos((ORIENT-VIEW_ANGL.E/20.0)*PI/180.0)  *  HYP; 
WIN->2MIN  =  2-CCD/2.0; 

WIN->ZMAX  =  2+CCD/2.0; 
return  WIN; 

)  /*  end  calc_window  */ 


void  lprint_l(L) 

LINE  *L; 


{ 

>Z1)  ; 


printf CXnNnline:  Xl=%.21f  Yl=%.21f  21=%.21f  ■ ,L->X1, L->Y1, L 
printfCXn  X2=%.21f  Y2=%.21f  22=%.21f  \n*,L->X2.L->Y2,L 


>Z2)  ; 

££lush(8tdout) ; 

) 
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void  lprint_llist (LIST) 

LINE_HEAD  ‘LIST; 


{ 


LINE  *NEXT_L=LIST->VLINE_LIST; 


printf ( * \n\n\nVertical  lines  (%d)  are : \n\n" . LIST- 
>VERT_LINES) ; 

while  (NEXT_L)  { 

lprint_l (NEXT_L) ; 

NEXT_L=NEXT_L- >NEXT ; 

) 

printf (■ \n\n\nnon-vertical  lines  (%d)  are : \n\n* , LIST- 

>LINES) ; 

£f lush(stdout) ; 

NEXT_L=LIST->LINE_LIST; 
while  (NEXT_L)  { 

lprint_l(NEXT_L) ; 

NEXT_L=NEXT_L- >NEXT; 


void  print_ljne (L) 

LINE  *L; 


{ 

Z2:%.41f 


printf (•\nXl:%.41f  Yl:%.41f  Zl:%.4if  X2:%.41f  Y2:%.41f 
L->X1 , L->Y1 , L->Z1, L->X2, L->Y2 , L->Z2 ) ; 


)  /*  end  print_line  */ 


LINE  *ina)ce_line(I,Vl,V2,Zl,Z2) 

INSTANCE  *1; 

VERTEX  *V1,  *V2; 
double  Z1.Z2; 

( 

LINE  *NEW_LINE; 

double  LOCAL_X,LOCAL_Y,  ROT_X,ROT_Y.  RADS; 


NEW_LINE  =  (LINE  *  )inalloc  (sizeof  (LINE) )  ; 
NEW_LINE->NEXT  =  NULL; 

/*  adjust  all  local  coordinates  to  pivot  point*/ 


93 


LOCAL_X  X  V1->X  -  I->PIVOT_X; 

LOCAL_Y  =  VI ->Y  -  I->PIVOT_Y; 

/*  rotate  about  the  z  axis  */ 

RADS  X  I->ROTATION  *  PI  /  180.0  ;  /*  convert  degs  to  rads  */ 

ROT_X  X  ( cos ( RADS ) •LOCAL_X ) ♦ ( s in ( RADS ) *LOCAL_Y ) ; 

ROT_Y  X  ( cos  { RADS )  *LOCAI._Y )  -  ( s in  ( RADS )  *LOCAL_X )  ; 

/•  translate  to  proper  position  in  world  model  •/ 

NEW_LINE->X1  X  I->X  +  ROT_X; 

NEW_LINE->Y1  X  I->y  ♦  ROT.Y; 

NEW_LINE->Z1  X  I->Z  +  Zl; 

/*  calc  second  vertex  */ 

LOCAL_X  X  V2->X  -  I->PIVOT_X; 

LOCAL_Y  =  V2->Y  -  I->PIVOT_Y; 

/*  rotate  about  the  2  axic  */ 

RADS  X  I->R0TAT10N  *  PI  /  180.0  ;  /*  convert  degs  to  rads  */ 

ROT_X  X  ( cos ( RADS ) *LOCAL_X ) + ( s in ( RADS ) •LOCAL_Y ) ; 

ROT_Y  X  (cos (RADS) *L0CAL_Y)- (sin (RADS) *LOCAL_X) ; 

/*  translate  to  proper  position  in  world  model  */ 

NEW_LINE->X2  x  I->X  +  ROT_X; 

NEW_LINE->Y2  x  I->Y  +  ROT_Y; 

NEW_LINE->Z2  x  I->Z  Z2; 

return  NEW_LINE; 

)  /*  end  make_line  */ 


void  add_lines (LIST, L) 


{ 


LINE_HEAD  *LIST; 
LINE  *L; 

LINE  *NEXT_LINE; 


if  (LIST->LINE_LISTx=NULL)  { 
LIST->LINE_LISTxL; 
LIST->TAILxL; 
LIST->LINESxl; 

} 

else  { 

LIST->TAIL->NEXTxL; 
LIST->LINES++ ; 
LIST->TAILxL; 

) 

)  /*  end  adcL.lines  */ 
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LINE_HEAD  *create_line  head() 

{ 

LINE_HEAD  *LH; 

if  ( (LH= (L1NE_HEAD  * )malloc ( sizeof (L1NE_HEAD) ) ) s=NULL) 
Pi^intf  (  •  \n\ncannot  create  line  head\n"); 
LH->LINES  a  0; 

LH->LINE_L1ST  =  NULL; 

LH->TA1L  =  NULL; 

return  LH; 

)  /*  end  create_line_head  •/ 


void  print_line_list (LH) 


{ 


LINE_HEAD  *LH; 


LINE  *NEXT_L; 


NEXT_L=LH - >LINE_LIST ; 

printf ( •\n\nThere  are  %d  lines:  \n\n" , LH->LINES) ; 
while  (NEXT_L)  { 

print_line(NEXT_L) ; 

NEXT_L =NEXT_L - >NEXT ; 


void  free_lines (LH) 

LINE_HEAD  *LH: 

{ 

LINE  *NEXT_L,  *TRASH; 


NEXT_L=LH - >LINE_L1 ST ; 
while  (NEXT_L)  { 

TRASH=NEXT_L; 
NEXT_L=NEXT_L- >NEXT ; 
free (TRASH) ; 

) 

NEXT_L=LH - >VLINE_LIST ; 

While  (NEXT_L)  { 

TRASH =NEXT_L, • 
NEXT_L=NEXT_L->NEXT; 
free (TRASH) ; 
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) 

£r««(LH) ; 

)  /*  end  frec.lincs  */ 


void  scale_line(L.SX,SY,SZ) 
LINE  *L; 

double  SX.SY.SZ; 


L->X1 

s 

L->X1 

* 

SX 

L->X2 

s 

L->X2 

• 

SX 

L->Y1 

s 

L->Y1 

SY 

L->Y2 

s 

L->Y2 

« 

SY 

L->Z1 

= 

L->Z1 

* 

SZ 

L->Z2 

L->Z2 

* 

SZ 

)  /*  end  scale_line  */ 


void  scale_window(W, SX, SY, SZ) 

WINDOW  *W; 
double  SX,SY,SZ; 

{ 

W->XMIN  s  W->XMIN  *  SX 
W->XMAX  s  W->XMAX  *  SX 
W->YMIN  =  W->YMIN  *  SY 
W->YMAX  =  W->YMAX  *  SY 
W->ZMIN  =  W->ZMIN  *  SZ 
W->ZMAX  =  W->ZMAX  *  SZ 
)  /*  end  scale_line  */ 


/*  shift  from  world  coordinates  to  machine  coordinates  */ 
void  shift_coord_line (L) 

LINE  *L; 

{ 

double  TEMPI,  TEMP2; 

TEMPI  =  L->Y1; 

TEMP2  *  L->Y2; 

L->Y1  =  L->Z1; 

L->Y2  =  L->Z2; 

L->Z1  *  TEMPI; 
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L->Z2  =  TEMP2; 

)  /*  end  shif t_coord_line  •/ 


/*  shift  from  world  coordinates  to  machine  coordinates  •/ 
void  shift_coord_window(W) 

WINDOW  *W; 

{ 

double  TEMPI,  TEMP2; 

TEMPI  =  W->yMlN; 

TEMP2  =  W->YMAX; 

W->YMIN  =  W->ZMIN; 

W->YMAX  =  W->ZMAX; 

W->ZMIN  =  TEMPI; 

W->ZMAX  =  TEMP2; 

)  /•  end  shif t_coord_window  •/ 


void  translate_line(L,X,Y, Z) 


{ 


LINE  ‘L; 
double  X,Y,Z; 

L->X1  +=  X; 
L->X2  +=  X; 
L->Y1  Y; 
L->Y2  Y; 
L->Z1  +=  Z; 
L->Z2  -t-s  Z; 


)  /*  END  TRANSLATE_LINE  •/ 


void  translate_window(W,X,  Y,  Z) 


{ 


WINDOW  *W; 
double  X,Y,Z; 

W->XMIN  +=  X; 
W->XMAX  +=  X; 
W->YMIN  +=  Y; 
W->YMAX  +=  Y; 
W->ZMIN  +=  Z; 
W->ZMAX  +=  Z; 


}  /*  END  TRANSLATE_WINDOW  */ 
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/*  rotat*  about  th«  vartical  axis  */ 


void  rot_z (L, ORIENT) 


LINE  *L; 
double  ORIENT; 

{ 

double  XlsL->Xl, 

X2*L->X2, 

Y1*L->Y1, 

Y2=L->Y2. 

RADS  =  ORIENT  *  PI  /  180.0  ;  /*  convert  degs  to  rads  •/ 

L->X1  e  Xl*cos(RADS)-Yl*sin(RADS) ; 

L->X2  =  X2*cos(RADS)-Y2*sin(RADS) ; 

L->Y1  »  Yl*cos (RADS) ♦Xl*sin (RADS) ; 

L->Y2  *  Y2*cos(RADS)+X2*sin(RADS) ; 


)  /*  end  rot_z  */ 

void  rot_window(W, ORIENT) 


{ 


WINDOW  *W; 
double  ORIENT; 

double  XMIN=W->XMIN. 

XMAX=W->XMAX, 

YMIN=W->YMIN, 

YMAX=W->YMAX, 

RADS  a  ORIENT  *  PI  /  180.0  ;  /*  convert  degs  to  rads  */ 


W->XMIN 

W->XMAX 

W->YMIN 

W->YMAX 


XMIN*cos (RADS) -YMIN*sin (RADS) ; 
XMAX* cos ( RADS )-YMAX* sin (RADS) ; 
YMIN*cos(RADS)+XMIN*sin(RADS) ; 
YMAX*cos (RADS) ♦XMAX*sin (RADS) ; 


)  /*  end  rot_z  */ 


void  perspective_transfonn(L, ZMIN) 

LINE  *L; 
double  ZMIN; 

{ 

double  W1xL->21/ZMIN  ,W2*L>>22/ZMIN; 

if  (W1!=0.0)  { 

L->X1=L->X1/W1; 

L->YlxL->Yl/Wl; 
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L->Z1=L->Z1/W1; 

) 

else 

printf ( ‘NnERROR  -  tried  to  divide  by  Wl=0\n*); 

if  (W2i=0.0)  { 

L->X2=L->X2/W2; 

L->y2*L->Y2/W2; 

L->Z2=L->Z2/W2; 

) 

else 

printf ( • \nERROR  -  tried  to  divide  by  W2=0\n‘); 

)  /*  end  perspective_transfonn  •/ 


void  get_clipping_codes (L, ZMIN) 
LINE  *L; 
double  ZMIN; 

{ 

int  i  ; 

for  (i=0;i<=5;++i)  { 
L->CLIPl[i]=0; 
L->CLIP2(i]=0; 

) 

if  (L->Y1>-L->Z1) 
L->CLIP1[0]=1; 
if  (L->Y1<L->Z1) 
L->CLIP1(11=1; 
if  (L->X1>-L->21) 
L->CLIP1[2]=1; 
if  (L->X1<L->Z1) 
L->CLIPlt3]=l; 
if  (L->Z1<-1.0) 
L->CLIP1[4]=1; 
if  fL->Zl>ZMIN) 
L->CLIP1[5]=1; 
if  (L->Y2>-L->Z2) 
L->CLIP2[0]=1; 
if  {L->Y2<L->Z2) 
L->CLIP2[1]=1; 
if  (L->X2>-L->Z2) 
L->CLIP2[2]=1; 
if  (L">X2<L->Z2) 
L->CLIP2I3]=1; 
if  (L->Z2<-1.0) 
L->CLIP2[4]=1; 
if  (L->Z2>ZMIN) 
L->CLIP2[5]=1; 
/*print_line (L) ; 
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printf ( ‘Nnclipping  codcl  »  %d  %d  %d  %d  %d  %d\n* , L->CLIP1 [ 0) , L- >CLIP1 1 1 1 
L->CLIP1[2] .L->CLIP1[3] .L->CLIP1I4] ,L->CLIP115] ) ; 
printf ( • \nclipping  ccxle2  *  %d  %d  %d  %d  %d  %d\n* , L->CLIP2 1 0 ] , L->CLIP2 [ 1 ] 
L->CLIP2[2],L->CLIP2[3] .L->CLIP214].L->CLIP2[5] ) ;•/ 

)  /•  end  g®t_clipping_cod«s  •/ 


void  dipt  (NUM.DENOM.TE.TL) 
double  MUM,  DENOM; 
double  "TE,  'TL; 

( 

double  t ; 

/•printf CNnNUM.  %.61f  DENOM=  %.61f  TE=  %.61f  TL* 

%.  61  f.  MUM,  DENOM,  *TE,  *TL)  ;*/ 

if  (DENOM<0.0)  { 
t=NUM/DENOM; 

/•printfC  t=  %.61f*.t)  ;•/ 
if  (t>*TL) 
t=t; 

/*  printf (* \nclipt  errorl*);*/ 

else 

if  (t>‘TE) 

*TE=t ; 

) 

if  (DENOM>0.0)  { 
t=NUM/DENOM; 

/•printfCts  %.61f,t);*/ 
if  (t<*TE) 
t=t; 

/*  printf (• \nclipt  error2*);*/ 

else 

if  (t<*TL) 


/*  if  (DENOM==0.0) 

printf ( ’Xnclipt  error  #3  -->  dividing  by  0.0*);*/ 
)  /•  end  dipt  */ 


void  dip_line(L,ZMIN) 
LINE  *L; 
double  ZHIN; 


double  dx,  dy,  dz; 
double  TMINsO.O,  TMAX=1.0; 


dxsL->X2-L->Xl; 
dy=L->Y2-L->Yl; 
dz=L->Z2-L->Zl ; 
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/•printf ( 'XHtmins  %.61f  tmax=  %.61£  zmin  =  % . 61f • , TMIN, TMAX, ZMIN) ; •/ 

dipt  (  (-L->X1-L->Z1)  ,  (dx+dz)  .iTVIN,  iTMAX)  ; 
dipt  '  L->X1-L->Z1)  ,  (-dx»dz)  ,  S.TMIN,  ilMAX)  ; 
d’’^’-  k  (L->Y1-L->Z1)  ,  (-dy+dz)  .  tTMIN.  iTMAX)  ; 

=  Upt(  (-L->Y1-L->Z1)  ,  (dy+dz)  .  S.TMIN,  JcTMAX)  ; 
dipt(  (-L->Z1-»ZMIN)  ,  (dz)  .  S.TMIN.  S.TMAX)  ; 
dipt  (  (-L->Z1-1) .  (-dz)  .&TMIN.&TMAX)  ; 
if  (TMAX<1)  { 

L->X2  =  L->X1  ♦  (TOAX*dx) ; 

L->Y2  =  L->Y1  4.  (TMAX*dy); 

L->Z2  =  L->Z1  *  (TMAX*dz); 

) 

if  (TMIN>0)  { 

L->X1  =  L->X1  +  (TMIN*dx) ; 

L->Y1  =  L->Y1  ♦  (‘IMIN*dy); 

L->Z1  =  L->Z1  4  (TMIN'dz); 

) 

)  /*  end  dip_lin€  •/ 


/*  returned  codes: 


•/ 


0  outside  of  view  volume 
1  partially  inside  volume 

2  entirely  in  view  volume 


int 

{ 


dip_line_3d(L) 
LINE  *L; 

int 


IN_V0LUME=1.  i.  C1=0  .C2=0; 


for  (i=0;i<=5;++i)  { 

Cl4=L->CLIPl[i] ; 

C2+=L->CLIP2(i] ; 

if  (  (L->CLIP1  (i]  ==!)&«,  (L->CLIP2  [ i]  ==1 )  ) 
IN_VOLUME=0;  /*  outside  view  volume  */ 

) 

if  (  (IN_VOLUME=sl)S.S.(  (C1=s0)&£.(C2==0)  )  ) 

IN_V0LUME=2;  /*  entirely  in  view  volume  •/ 
return  IN_VOLUME; 

)  /*  end  dip_line_3d  */ 


void  display_window(W) 
WINDOW  ‘W; 

{ 

int  DUMMY; 
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printf ( •\n\nWindow  limits  calculated:  *); 

printfCXnX:  %.21f-%.21f \nY:  % . 21£-% .21f \nZ :  %.21f-%.21f \n\n 
W->XMIN, W->XMAX. W->YMIN. W->yMAX, W->ZMIN, W- >ZMAX ) 
f flush (stdout) ; 

printf (• \n\nEnter  a  number  to  continue*); 

/•scanf (•%d*,&DUMMy) ;•/ 

) 

double  myabs(X) 
double  X; 

( 

if  (X<0.0) 

X=0.0-X; 
return  X; 


void  map_to_screen (L, XMIN, YMIN) 

LII«:  *L; 

double  XMIN.YMIN; 

{ 

L->X1  =  myabs ( (L->X1-XM1N) / (2*XMIN) *MAX_X) 
L->X2  =  myabs ( (L->X2-XMIN) / (2*XM1N)*MAX_X) 
L->Y1  =  myabs( (L->Yi-YMIN;/(2*YMIN)*MAX_Y) 
L->Y2  =  myabs ( (L->Y2-YMIN) / (2*YMIN) *MAX_Y) 

/*  1279.0  ,  1023.0  */ 

)  /•  end  map_to_screen  */ 


/*  retrun  with  1  if  line  was  not  totally  clipped  out  of  view 

int  project_line(X, Y, Z, ORIENT. L.W.Wl.FL) 

double  X,Y,Z, ORIENT; 

LINE  *L; 

WINDOW  •W,*W1; 
double  FL; 

{ 

double  ZMIN,SCALEX,SCALEY,SCALEZ,VFP_Z; 
int  USED_LINE=:1,  CLIPT; 
double  £1=1.24; 

double  Xl.Yl.Zl.XTEMP.YTEMP.RADS; 


translate_line {L, -W->XMIN, -W->YMIN, -W->ZMIN) ; 
rot_2(L, -ORIENT) ; 

X1=X-W->XMIN; 

Y1=Y-W->YMIN; 
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Z1=2-W->ZMIN; 

XTEMP=X1 ; 

YTEMP=Y1; 

RADS  =  ORIENT  *  PI  /  180.0  ;  /*  convert  degs  to  rads  */ 

XI  s  XTEMP* cos ( -RADS )-YTEMP*s in ( -RADS ) ; 

Y1  =  YTEMP*cos(-RADS)-vXTEMP«sin(-RADS)  ; 

translate_line (L, -XI, -Yl, -Zl) ; 

/*  change  from  world  to  view  coords  */ 

/*  shear  so  view  volume  centered  on  z-axis  */ 

/*  now  scale  view  vol  to  unity  using  s_per  */ 

/*  NOTE:  FAR_CLIP  is  global  value  •/ 

VRP_Z  =  -Yl;  /‘since  still  in  world  coords*/ 

SCALEX  =  2 . 0*VRP_Z/ ( (W1->XMAX-W1->XMIN) * (VRP_Z+FARCLIP) ) ; 
SCALEY  =  2.0*VRP_Z/( {W1->YMAX-W1->YMIN)*(VRP_Z+FARCLIP) ) ; 
SCALEZ  =  -1.0/(VRP_2+FARCLIP); 
shif t_coord_line (L) ; 
scale_line(L,SCALEX, SCALEY. SCALEZ) ; 

/•printf ( “Xnafter  scaling:  * ) ; 
print_line (L) ;*/ 

ZMIN=SCALEZ* (VRP_Z+NEARCLIP) ; 

/♦printf ( "VuZMIN  =  % . 51f * , 2MIN) ; */ 

get_clipping_codes (L, ZMIN) ; 

/*  divide  by  w/d  */ 

CLIPT=clip_line_3d(L) ; 
if  (CLIPT'sO)  { 

if  (CLIPT==1) 

cUp_line  (L.ZMIN); 

/•printf ( “Xnafter  clipping:"); 
print_line (L) ; */ 

perspective_transform(L, ZMIN) ; 

/•printf ( *\nafter  M-per*); 

print_line{L) ;*/ 
map_to_screen(L, ZMIN, ZMIN) ; 

/*printf ( ■ \naf ter  map  to  screen\n\n*); 

print_lin*» fl  )  ;*/ 


) 

else 

USED_LINE=0; 
return  USED_LINE; 

)  /*  end  project_line  */ 


void  remove_line (L, LH) 

LINE  *L; 
LINE_HEAD  *LH; 

{ 


LINE  *NEXT_L=LH->LINE_LIST, 


♦TRASH; 
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if  (L==LH->LINE_LIST)  { 

LH - >LINE_LIST=LH- >LINE_LIST- >NEXT ; 
free (L) ; 

) 

else  { 

while  (  (NEXT_L->NEXT)«.£c{NEXT_L->NEXT!=L)  )  { 
NEXT_LaNEXT_L- >NEXT ; 

) 

NEXT_L->NEXT=NEXT_L - >NEXT- >NEXT ; 
free (L) ; 

) 

LH->LINES--; 

)  /*  end  remove_line  •/ 


void  remove_vert_line (L, LH) 
LINE  *L; 
LINE_HEAD  *LH; 


{ 


LINE  *NEXT„L=LH->VLINE_LIST, 


•TRASH; 


if  (L==LH->VLINE_LIST)  { 

LH->VLINE_LIST=LH->VLINE_LIST->NEXT; 
free(L) ; 

) 

else  { 

while  ( (NEXT_L->NEXT)tS.(NEXT_L->NEXTi=L) )  { 
NEXT_L=NEXT_L->NEXT ; 

} 

NEXT.L- >NEXT=NEXT_L - >NEXT- >NEXT ; 
f ree (L) ; 

) 

LH->VERT_LINES-- ; 

)  /*  end  reinove_vert_line  */ 


LINE.HEAD  *get_view ( PRPX, PRPY.PRPZ, ORIENT, W.FL) 

double  PRPX, PRPY, PRPZ, ORIENT, FL; 
WORLD  *W; 

{ 

LINE 

LINE_HEAD 
WINDOW 
WINDOW 
double 
int 


*NEXT_L, *TRASH; 

*LH; 

*WIN=calc_window(PRPX, PRPY, PRPZ, ORIENT, FL) ; 
*Wl=calc_window( PRPX, PRPY, PRPZ, ORIENT,  FL) ; 

Zl,  Z2,  temp,  XX,  YY,  ZZ,  RADS,  XTEMP,  YTEMP 
count=0; 


translate_window(Wl, - {WIN->XMIN) , - (WIN->YMIN) 


-(WIN->ZMIN) ) ; 

rot_window(Wl, -ORIENT) ; 

XX= PRPX-WIN- >XMIN ; 

Yy=PRPy-WIN->yMIN; 

ZZ=PRPZ-WIN->ZMIN; 

XTEMPxXX; 

yTEMP=yy; 

RADS  =  ORIENT  *  PI  /  180.0  ; 

XX  =  XTEMP*cos ( -RADS) -yTEMP*sin( -RADS) ; 
yy  =  yTEMP*cos ( -RADS) +XTEMP*sin( -RADS); 


translate_window(Wl , -XX, -yy, -ZZ) ; 

/*  change  from  world  to  view  coords  */ 
shift_coord_window{Wl) ; 

LH=conduct_visibility_sweep{W, PRPX, PRPY, PRPZ) ; 
NEXT_L=LH - >VLINE_LIST ; 
while  (NEXT_L)  { 

/*printf CVnRAW  LINE:"); 
lprint_l (NEXT_L) ; */ 

if 

{project_line(PRPX,PRPy, PRPZ, ORIENT,NEXT_L, WIN, W1,FL) !=1)  { 

TRASH=NEXT_L; 

NEXT_L=NEXT_L - >NEXT ; 
ren>ove_ver t_l  ine  ( TRASH ,  LH )  ; 


/*lprint_l(NEXT_L) ;*/ 


NEXT_LsNEXT_L->NEXT; 


)  /*  end  while  */ 

NEXT_L=LH->LINE_LIST; 
while  (NEXT_L)  { 
if 

(project_line(PRPX,PRPy,PRPZ,ORIENT,NEXT_L,WIN,Wl,FL) !=1)  { 

TRASH=NEXT_L; 
NEXT_L=NEXT_L- >NEXT ; 
reinove_l  ine  ( TRASH ,  LH )  ; 

) 

else  { 

NEXT_L=NEXT_L - >NEXT ; 

) 

}  /*  end  while  */ 


/* 

printf  (  *\nCon^>leted  projectionXn" ) ; 

printf ( * \n\nVert  lines  kept  =  %d\nOthers  =  %d\n" ,LH->VERT_L1NES,LH- 
>LINES)  ; 
f flush (stdout) ; 

*/ 

free (WIN) ; 
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free (W1 ) ; 
return  LH; 
)  /*  end  get_view  */ 


LINE_HEAD 


{ 


*get_view_orig (PRPX, PRPY, PRPZ, ORIENT, W,FL) 

double  PRPX, PRPY, PRPZ, ORIENT, FL; 

WORLD  *W; 

POLYHEDRON  *NEXT_PH; 


POLYGON  *NEXT_PG; 

VERTEX  *NEXT_V; 

INSTANCE  *NEXT_I ; 

LINE  *NEXT_L; 

LINE_HEAD  *LH=create_line_head ( ) ; 

WINDOW  *WIN=calc_window (PRPX, PRPY, PRPZ, ORIENT, FL) ; 

WINDOW  *Wl=calc_window(PRPX, PRPY, PRPZ, ORIENT, FL) ; 

double  Zl,  Z2,  temp,  XX,  YY,  ZZ,  RADS,  XTEMP,  YTEMP; 

int  count =0; 


translate_window (W1 , - (WIN->XMIN) , - {WIN->YMIN) , 

-(WIN->ZMIN) ) ; 

rot_window (W1 , -ORIENT) ; 


XX=PRPX-WIN->XMIN; 

YY=PRPY -WIN- >YMIN ; 

ZZ=PRPZ-WIN->ZMIN; 

XTEMP=XX; 

YTEMP=YY; 

RADS  =  ORIENT  *  PI  /  180.0  ; 

XX  =  XTEMP*cos ( -RADS) -YTEMP*sin( -RADS) ; 

YY  =  YTEMP*cos(-RADS)+XTEMP*sin(-RADS); 

translate_window(Wl , -XX, -YY, -ZZ) ; 

/*  change  from  world  to  view  coords  */ 
shift_coord_window(Wl) ; 

NEXT_PH=W->POLYHEDRON_LIST; 
while  (NEXT_PH)  { 

NEXT_I=NEXT_PH->INSTANCE_LIST; 
while  (NEXT_I)  { 

NEXT_PG=NEXT_PH->POLYGON_LIST; 
while (NEXT_PG)  { 

NEXT_V=NEXT_PG- >VERTEX_LIST ; 
Zl =NEXT_PG- >Z_VALUE ; 
while (NEXT_V)  { 

if  (NEXT_V->VERT_EDGE)  { 
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>VERT_EDGE) ; 
>VERT_EDGE, Z1 , 22 ) ; 


Z2=f ind_z ( NEXT_PH , NEXT_V- 
NEXT_L=inake_line  (NEXT_I ,  NEXT_V,  NEXT_V- 


printf  CVnRAW  LINE:-); 
lprint_l (NEXT^L) ; 
count-*-+; 

if 

( pro j  ect_l ine { PRPX , PRPY , PRPZ , ORIENT . NEXT.L . WIN . W1 , FL) *= 1 )  { 


printf ( • \nACCEPTED\n* ) ; lprint_l (NEXT_L) ; 


add_l ines ( LH , NEXT_L ) ; 

) 

)  /*  end  if  */ 

if  (NEXT_V->NEXT)  { 

NEXT_L=make_l ine (NEXT_I , NEXT_V, NEXT_V->NEXT. Zl.Zl); 
printf ( "NnRAW  LINE:'); 
lprint_l (NEXT_L) ; 
count ++ ; 

if 

(project_l ine (PRPX, PRPY, PRPZ, ORIENT, NEXT_L,WIN.W1,FL)==1)  { 


printf CSnACCEPTEDXn') ; 
Iprint.l fNEXT_L) ; 


add_lines(LH,NEXT_L) ; 


>VERTEX_LIST,  Z1 ,  Z1 ) ; 
printf  CXnRAW  LINE:'); 
lprint_l(NEXT_L) ; 
count ++ ; 


if 


) 

NEXT_V®NEXT_V- >NEXT ; 

)  /*  end  if  */ 

else  { 

NEXT_L=make_l ine ( NEXT_I , NEXT_V , NEXT.PG- 


(pro ject_line { PRPX, PRPY, PRPZ, ORIENT, NEXT^L, WIN, W1 , FL) *=1 )  { 


printf ( ' \nACCEPTED\n' ) ; 
lprint_l (NEXT_L) ; 


add_lines (LH,NEXT_L) ; 


NEXT_V=NULL; 

)  /*  end  else  */ 

}  /•  end  while  */ 

NEXT_PG=NEXT_PG- >NEXT ; 
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)  /*  end  while  */ 

NEXT_I =NEXT_1 - >NEXT ; 

)  /*  end  while  •/ 

NEXT_PH=NEXT_PH ->NEXT ; 

}  /*  end  while  */ 

/*  print_line_list (LH) ; 

printf ( * \n\nTotal  lines  considered  s  %d\n\n* , count) ; 
printf ( • \n\nTotal  lines  accepted  =  %d\n\n* , LH->LINES) ; */ 
printf ( •\n\nLines  returned  by  get_view_orig\n\n’); 
lprint_llist (LH) ; 

return  LH; 

)  /*  end  get_view_orig  */ 
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/* 

FILE  NAME: 
AUTHOR : 
PROJECT: 
DATE: 
ADVISOR: 


visibility .h 
James  Stein 

Thesis,  supporting  Yamabico  vision  system 
March  1992 
Dr .  Kanayaina 


COMMENTS:  This  file  implements  a  algorithm  which  determines  the  set  of 
visible  line  seen  from  a  given  position  in  a  wire  frame  model.  The  observer 
is 

assumed  to  have  omni-directional  vision.  To  impose  the  physical  limits  of 
a  c«unera‘s  field  of  view,  the  function  get_view  in  file  graphics. h  can  be 
sent  a  model  (as  it  in  turn  uses  this  file) . 


Primary  Function(s): 


-  conduct_vsiibility_sweep 

INPUT:  W  a  pointer  to  a  2d-f  world  model 

EYE_X, EYE_Y, EYE_Z  position  of  observer  in  model  W 

OUTPUT:  LINE_LIST  structure  pointing  to  2  lists  of 

visible  vertical  and  non-vertical 

lines 

*/ 


/* - Structure  definitions: 


typedef  struct  sweep_link  { 

double  THETA,  X,  Y,  Z, 

MIN_Z,  MAX_Z,  UPPER_Z,  DIST; 
VERTEX  *V; 

INSTANCE  *1; 

POLY_LINK  ‘CEILINGS; 

struct  sweep.link  *PREV,  ‘NEXT; 

}  SWEEP_LINK; 


/‘ 


‘/ 


typedef  struct  considered_link  { 
double  MIN.SWEEP, 

MIN_Z,  MAJ^Z,  DIST, 

NEW_MIN_Z , NEW_MAX_Z , UPPER_Z ; 

int 

VISIBILITY, B_VISIBILITY,NEW_VISIBILITY,NEW_B_VISIBILITY; 
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POLY_LINK  ‘CEILINGS; 
SWEEP_LINK  *SL1.  ‘SLa; 
struct  cons idered_l ink  ‘NEXT; 
)  CONSIDERED_LINK; 


/* 


/ 


typedef  stiuct  considered_head  { 

CONSIDERED_LINK  ‘LINKS; 

)  CONSIDERED_HEAD; 

/‘ . . . . . . - . ‘/ 


/‘  global  variables;  ‘/ 


static  double  X.Y.Z; 
static  double  THETA; 
int  IN_MAIN; 


/‘Position  of  observer  within  the  inodel‘/ 
/‘Current  angle  of  visibility  sweep‘/ 

/‘if  0  we  are  still  preprocessing  straddlers‘/ 


void  line_ray_intersection(CONSIDERED_LINK  ‘CL, double  ANGLE, 

double  ‘INT_X, double  ‘INT_Y, double 


‘DIST)  ; 


/*  Doubles  can  be  truncated  to  4  decimal  places  to  compensate  for 
inexactness 

of  floating  point  operations‘/ 

double  trunc(X) 
double  X; 

{ 

int  DUMMY; 
double  XX=X; 

DUMMY=XX‘10000; 

XX=DUMMY; 

XX=XX/10000.0; 
return  XX; 


/““““ 
FUNCTIONS 

double  degs(RADS) 
double  RADS; 

{ 


CONVERSION 

/ 
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return  trunc(RADS*180.0/PI)  ; 


) 


doubl c  r ads ( DECS ) 
double  DEGS; 

{ 

return  trunc(DEGS*Pl/180.0)  ; 

} 


/ 


/ 


/*  Determines  if  the  edges  from  2  considered  links  are  colinear*/ 


int  colinear (F,B) 

CONSIDERED_LINK  "F, *B; 

{ 


double  Ml, M2;  /*we  will  compare  slopes  and  distance*/ 


) 


Mlstrunc ( (F->SL1->Y-F->SL2->Y) / (F->SL1->X-F->SL2->X) ) ; 
M2=trunc ( (B->SL1->Y-B->SL2->Y) / (B->SL1->X-B->SL2->X) ) ; 
if  ( (M1==M2 ) && (F->DIST==B->DIST) ) 
return  1; 

else 

return  0; 


/*«**********.*****.**«******.*counter  clockwise 

CHECKS** •*************•**•**/ 


int  ccw(SL, PREV_SL) 

SWEEP_LINK  *SL, 


{ 


double  AREA; 


*PREV_SL; 


AREA=  0.5*( (SL->X-X)*(PREV_SL->Y-Y)- 
(PREV_SL->X-X)  * (SL->Y-Y) ) ; 
if  (AREA>0.0) 
return  1; 
else 

return  0; 

}  /*  end  ccw  */ 


int  ccw2(SLl,SL2,SL3) 
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{ 


SWEEP.LINK  *SL1 . •SL2 . *SL3 ; 
doubls  AREA; 


AREA*  0.5*((SL2->X-SLl->X)*(SL3->y-SLl->Y)- 
(SL3->X-SL1->X) * (SL2->y-SLl->y) ) ; 
if  (AR£A>0.0) 
return  1; 

•  Is* 

return  0; 

)  /*  end  ccw  */ 


/ 


/ 


/*  Finds  the  angle  from  XI, yi  to  V  for  use  in  determining  if  XI, Yl  lies 
within  the  bounds  of  a  polygon.*/ 

double  f ind_theta(Xl,yi, V, 1) 
double  XI, Yl; 

VERTEX  *V; 

INSTANCE  *1; 

{ 

double  X2,Y2.T; 

double  LOCAL_X , LOCAL.Y , ROT_X , R0T_Y , RADS ; 

LOCAL.X  *  V->X  -  I->PIV0T_X; 

LOCAL_Y  *  V->y  -  I->PIV0T_Y; 

/*  rotate  about  the  z  axis  */ 

RADS  =  I->ROTATION  *  PI  /  180.0  ;  /*  convert  degs  to  rads  •/ 

ROT_X  =  ( cos ( RADS ) *LOCAL_X ) + ( s in ( RADS ) *LOCAL_Y ) ; 

ROT_Y  a  (cos (RADS) *L0CAL_y) - (sin (RADS) *LOCAL_X) ; 

/*  translate  to  proper  position  in  world  mode)  */ 


) 


X2  =  I->X  +  R0T_X; 
y2  *  I->y  +  ROT.Y; 
if  ( (Xla=X2)  I  I  ( (yi*=Y2)«.&(Xl==X2) ) ) 
T=0.0; 

else 


if  (T<0,0) 
return  T; 

/*  end  find^theta  */ 


Taatan2(Y2-yi,X2-Xl) ;  /*  both  won't  be  0 

T+arads (360.0) ;  /*  normalize  to  0-360  */ 


*/ 
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/*  This  function  deterininss  if  the  point  XI, Y1  lies  within  the  polygon,  PG. 
The  angle  formed  between  lines  drawn  to  each  edge  of  PG  is  calculated. 
CW  angles  are  added  and  CCW  ones  are  subtracted  from  the  sum. 

If  the  sum  is  not  equal  to  0.0  the  point  is  within  PG  and  1  is 
returned. */ 

int  in_polygon(Xl,Yl, PG, I) 
double  XI, Yl; 

POLYGON  ‘PG; 

INSTANCE  *1; 

{ 

VERTEX  *FIRST_V,  *V=PG->VERTEX_LIST; 

double  THETAl ,  THETA2 ,  FIRST_THETA,  SUM=0 . 0 ,  SUM1=0 . 0  ,- 

double  XX, YY; 


THETA2=f ind_theta{Xl,Yl,V,l) ; 

FIRST_V=V; 

FIRST_THETA=THETA2 ; 
while  (V->NEXT)  { 

if  (  (Xl==V->X)S.Jt(Yl==V->Y)  ) 

SUM1=1.0;  /*if  directly  under 


a  point  accept*/ 

THETA1=THETA2; 

THETA2=find_theta(Xl,Yl,V->NEXT, I) ; 


/*ccw*/ 


if  ( (0.5*((V->X-X1)*(V->NEXT->Y-Y1)- 
(V->NEXT->X-X1)*(V->Y-Y1) ) )>0.0)  { 


if  (THETA2<THETA1) 


SUM+= (THETA2+rads (360.0)) -THETAl ; 


/*cw*/ 


) 

else  { 


else 

SUM+=THETA2 -THETAl ; 


if  (THETA2>THETA1) 

SUM+=THETA2- 


(THETAl+rads( 360.0) )  ; 


else 


/•Lastly : 


Yl) )  )> 


SUM+=THETA2 -THETAl ; 

) 

V=V->NEXT; 

)  /*  end  while  */ 

check  the  closing  edge  to  see  if  we  add  or  subtract  its  angle*/ 
THETAl =THETA2 ; 

THETA2  =FIRST_THETA ; 

if  ( ( 0 . 5* ( {V->X-X1 ) * (FIRST_V->Y-Y1 ) - {FIRST_V->X-X1 ) * {V->Y- 

0.0)  {  /*ccw*/ 

if  (THETA2<THETA1) 

SUM-*-=  (THETA2+rads  (360.0))  -THETAl  ; 
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} 


else 

SUM-^=THETA2-THETA1  ; 

) 

else  ( 

if  (THETA2>THETA1) 

SUM+=THETA2-(THETAl+rads(360.0) ) ; 

else 


SUM+  =THETA2 -THETAl ; 

) 

if  ( ( <trunc(SUM)==0.0)  )Ji£<(SUMl==0.0) ) 
return  0; 

else 


return  1 ; 


/*  Function  checks  to  see  which  ceiling  of  CL's  ceiling  list  the  1st 
endpoint 

falls  under.  This  height  is  returned  and  is  used  to  determine  how  much 
coverage  the  CL  has  along  the  z-eocis  (that  is  what  angle  bound  the 
portion 

of  the  z-axis  which  CL  occludes*/ 


double 

{ 


f ind_ceiling_z (CL) 

CONSIDERED_LINK  *CL; 

double  IX, IV,DIST,CEILING_Z_VALUE=(-9999999.9) ; 
POLY.LINK  *NEXT_C=CL->CEILINGS; 
int  FOUNDS 0; 


IX=CL->SL1->X; 
iy=CL->SLl->Y; 
while  (NEXT_C)  { 

/•keep  track  of  highest  ceiling  over  CL*/ 

if  (  (in_polygon(  IX,  IY,NEXT_C->REF_P0LY,CL->SL1->I  )==!)£.£. 
( NEXT_C - >REF_POLY - >Z_VALUE+  CL- >SL1 - > I - 
>Z>CEILING_Z_VALUE) )  { 


>SL1->I->Z; 


CE I L ING_Z_VALUE=NEXT_C - >REF_POLY - > Z_VALUE+  CL - 


FOUNDS 1; 

) 

NEXT_C sNEXT_C - >NEXT ; 

) 

if  (FOUNDs=0)  { 

CEILING_Z_VALUEsCL->SLl->UPPER_Z;  /*if  none  ht  same  as 

endpoint*/ 

) 

return  trunc (CEILING_Z_VALUE) ;  /*return  highest  ceiling 

ht*/ 

)  /*  end  f ind_ceiling_2  */ 
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/*  Calculate  the  minimum  and  maximum  angles  which  SL  covers  on  the  z-axis. 
Any  object  which  is  farther  away  and  behind  SL  that  falls  within  these 
limits  will  not  be  able  to  be  seen.  */ 


void  calc_2_coverage (SL) 

SWEEP_LINK  ‘SL; 


{ 


double  dz.LEN; 


dz=SL->2-Z; 

LEN=SL->DIST;  /*dist  to  line  in  X-Y  plane*/ 
if  (LEN==0) 

LEN=0. 00001; 

SL->MIN_Z=trunc (atan (dz/LEN) ) ; 
dz=SL->UPPER_Z-Z; 

SL->MAX_Z=trunc (atan (dz/LEN) ) ; 

)  /*  end  calc_z_coverage  */ 


/*  Absolute  value  of  a  double  */ 


double  my_abs(A) 

double  A; 

{ 

if  (A>=0.0) 
else 


return  A; 
return  -A; 


/•  Calculates  the  limiting  angles  along  the  z~eixis  for  each  item  on  the 
considered  list.  These  limits  are  based  upon  the  height  of  each 
endpoint  (value  of  CL->MIN_Z)  and  the  height  of  the  ceiling  (if  any) 
lying  above  CL  (CL->UPPER_Z) .  */ 


void  calc_current_z_coverage (CLIST) 
CONSIDERED.HEAD  *CLIST; 


{ 


CONSIDERED_LINK  *CL=CLIST->LINKS; 
double  MIN.MAX.DIST; 
double  dx,dy,dz, IX, IY,LEN1.LEN2, 
CEILING_Z; 


while  (CL)  { 

CL->NEW_>4AX_Z=trunc(atan( (CL->UPPER_Z-Z) /CL->DIST) ) ; 
CL->NEW_MIN_Z=trunc(atan( (CL->SL1->Z-Z) /CL->DIST) ) ; 
CL->NEW_VISIBILITY=1 ;  /‘reset  visibilities*/ 
CL->NEW_B_VISIBILITY=1 ; 
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CL=CL->NEXT; 


) 

}  /•  end  calc_current_2_coverage  •/ 


/••*** . . . •MEMORY  ALLOCATION 

FUNCTIONS**  . . ...*.**..*/ 


LINE_HEAD  *make_l ine_head ( ) 

I 

LINE_HEAD  *LH= (LINE_HEAD  *)malloc (sizeof (LINE_HEAD) ) ; 

LH->LINES=0; 

LH - >VERT_LINES = 0 ; 

LH->LINE_LIST=NULL; 

LH->TAIL=NULL; 

LH- >VLINE_L1ST=NULL ; 

LH->VTAIL=NULL; 
return  LH; 

}  /*  end  inake_line_head  */ 


CONSIDERED_HEAD  *inake_considered_head  ( ) 

{ 

CONSIDERED_HEAD  *CH; 

CH=  (CONSIDERED.HEAD  * )malloc ( sizeof (CONSIDERED.HEAD) ) 

CH->LINKS=NULL; 

return  CH; 

)  /*  end  inake_considered_head  */ 


SWEEP_LINK  *make_sweep_link(PH, PG, V, I, PG_Z) 

POLYHEDRON  *  PH.- 
POLYGON  *PG; 

VERTEX  *V; 

INSTANCE  *1; 
double  PG_Z; 

{ 

SWEEP_LINK  *SL; 

double  LOCAL_X , LOCAL_Y , ROT_X , ROT.Y , RADS ; 

SL*  (SWEEP_LINK  'jraallocCsizeof (SWEEP_LINK) ) ; 
SL->PREV=  NULL; 

SL->NEXT=  NULL; 

SL->V=V; 
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SL->I=I; 

SL->CEILINGS=PG->CEILING_LIST; 
LOCAL_X  =  V->X  -  I->PIVOT_X; 
LOCAL_Y  =  V->Y  -  I->PIVOT_Y; 


/*  rotate  about  the  z  axis  */ 

RADS  =  I->ROTATION  *  PI  /  180.0  ;  /*  convert  degs  to  rads  */ 

R0T_X  =  ( cos ( RADS ) *LOCAL_X ) ♦ { s i n ( RADS ) *LOCAL_Y ) ; 

R0T_Y  =  ( cos ( RADS ) *L0CAL_Y ) - ( s in ( RADS ) *L0CAL_X ) ; 


/•  translate  to  proper  position  in  world  model  •/ 


SL->X  =  trunc(I->X  +  R0T_X) ;  /‘roust  be  truncated*/ 
SL->Y  =  trunc(I->Y  +  R0T_Y) ; 

SL->Z  =  trunc(I->Z  +  PG_Z) ; 


360  */ 

X) .2.0)  )  )  ; 


SL->THETA=(atan2(SL->Y-Y,SL->X-X) ) ;  /*  both  won’t  be  0  */ 

if  (SL->THETA<0.0) 

SL->THETA=(2.0*PI+SL->THETA) ;  /*  normalize  to  0- 
SL->DIST=  trunc (sqrt (pow( (SL->Y-Y) , 2 . 0) +pow( (SL->X- 
if  (V->VERT_EDGE) 

SL->UPPER_Z=£ind_z{PH.V->VERT_EDGE)+l->Z; 

else 


SL->UPPER_2=SL->2; 

if  (  (PH->OBSTACLE=  =  0)ScSt(PG->FLOOR==0)  ) 
SL->UPPER_Z=99999999999 . 9 ; 


90  degs*/ 

calc_z_coverage  (SL.)  ; 
return  SL; 

)  /*  end  inake_sweep_link  */ 


/*max  float  '.o  cover 


CONS IDERED_LINK  *make_cons i der ed_l i nk ( SL ) 
SWEEP_LINK  *SL; 


{ 


CONSIDERED_LINK  *CL= (CONSIDERED_LINK 
*)malloc(sizeof {CONSIDERED_LINK) ) ; 


CL->SL1=SL; 
CL->DIST=SL->DIST; 
CL->SL2=SL->PREV; 
CL->CEILINGS=SL->CEILINGS; 
CL->VISIBILir/=l; 
CL->B_VISIBILITY=1 ; 
CL->NEW_VISIBILITY=1 ; 
CL->NEW_B_VISIBILITY=1 ; 
CL->NEXT=NULL; 
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)  /* 


CL->MIN_SWEEP=SL->THETA; /*8«t  min  to  rsflect  sweep  so  far*/ 
CL->MIN_Z«SL->MIN_2; 

CL->MAX_2=SL->MAX_Z ; 

if  (CL->SL1->UPPER_Z>9999999 .9)  /*naed  to  trunc????*/ 
CL->UPPER_Z=99999999999.9; 

else 


CL->UPPER_Z»f ind_ceiling_2 (CL) ; 

return  CL; 

make_considered_link  •/ 


/ 


/•****•** . ******* ****«***MEMORY 

DEALLOCATION . * . / 


f ree_sweep_list (SLIST) 
SWEEP_LINK  ‘SLIST; 

SWEEP_LINK  *TRASH=SLIST; 

while  (TRASH)  { 

SLlSTaSLIST->NEXT; 
free (TRASH) ; 
TRASHaSLIST; 

) 

)  /*  end  f ree_sweep_list  •/ 


void 

( 


void  fr€e_clist (CLIST) 

CONSIDERED_HEAD 


{ 


CONSIDERED_LINK 


•CLIST; 

•NEXT_CLaCLIST->LINKS, ‘TRASH; 


while  (NEXT_CL)  { 

TRASH aNEXT_CL ; 
NEXT_CLaNEXT_CL->NEXT; 
free (TRASH) ; 

) 

free (CLIST) ; 

)  /*  end  free_clist  */ 


/ 


“/ 
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DISPLAY 


/**••**** 

FUNCTIONS 

NOTE:  These  functions  were  used  in  debugging,  but  they  have  been  left 
in  case  inspection  of  intermediate  results  is  needed  in  the  future.* 


void  print_l{L) 

LINE  *L; 

{ 


>Z1)  ; 
>22)  ; 


printf CXnVnline;  Xl=%.21f  yi=%.21f  Zl=%.21f  *  ,L->X1,L->Y1,L 
printf CXn  X2=%.21f  Y2=%.21f  Z2=%.21f  \n*,L->X2,L->Y2,L 


) 


f flush (stdout) ; 


void  print_llist (LIST) 

LINE_HEAD  ‘LIST; 


{ 


LINE  *NEXT_L=LIST->VLINE_LIST; 


printf (■ \n\n\nVertical  lines  (%d)  are: \n\n* ,LIST- 
>VERT_LINES) ; 

while  (NEXT_L)  ( 

print_l (NEXT_L) ; 

NEXT_L=NEXT_L- >NEXT ; 

) 

printf ( ‘XnXnXnnon-vertical  lines  (%d)  are : XnXn" , LIST- 

>LINES) ; 

f flush (stdout) ; 

NEXT_LaLIST->LINE_LIST; 
while  (NEXT_L)  { 

print_l (NEXT_L) ; 

NEXT_L=NEXT_L- >NEXT ; 


void  print_sl(SL) 

SWEEP_LINK  *SL; 

{ 


printf CXnSL:  X=%.21f  Y=%.21f  Z=%.21f •,SL->X,SL->Y,SL->Z) ; 
printf CXn  THETA=%.201f  DIST=% .21f * , degs (SL->THETA) , SL- 

>DIST)  ; 

printf CXn  MIN_Z=%.21f  MAX_Z=%.21f ■ , 

degs (SL->MIN_2) , degs (SL->MAX_Z) ) ; 
if  {SL->PREVs=NULL) 


printf  (  "XnWarning  no  previous  lin)c*); 
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if  (SL->NEXT«xNULL) 

printf ( 'Warning  should  be  last  link'); 
fflush(stdout) ; 

)  /*  end  print_8l*/ 


void  print.slist (SL) 

SWEEP_L1NK 


{ 


SWEEP_LINK 


*SL; 

•NEXT.SLxSL; 


printf (■\n\nSWEEP  LIST: \n\n* ) ; 
while  (NEXT_SL)  { 

print_8l (NEXT_SL) ; 
NEXT_SL=NEXT_SL->NEXT ; 


void  print_cl(CL) 

C0NSIDERED_L1NK 

{ 


*CL; 


printf CXnXn  MIN_Z=%.21f  MAX_Zx% .21f ' , 
degs (CL->MIN_Z) , degs (CL->MAX_Z) ) ; 
printf(’\n\n  NEW_MIN_Z=% .21f  NEW_MAX_Z»% .21f • , 

degs (CL->NEW_MIN_Z) , degs (CL->NEW_>1AX_Z) ) ; 
printfCXn  MIN_SWEEP=%  .21f  DIST=%.21f, 

degs(CL->MIN_SWEEP) ,CL->DIST) ; 
printf ( • \nUPPER_Z : % . 21f  * , CL->UPPER_2) ; 

printf CNnOLD:  VISIBLE=%d  B_VISIBLE=%d* . CL->VISIBILITY, CL- 
>B_VISIBILITy) ; 

printf CXnNEW:  VISIBLE=%d  B_VISIBLE=%d* , 

CL->NEW_VISIBILITy, CL->NEW_B_VISIBILITY) ; 
print_sl (CL->SL1) ; 
print_sl (CL->SL2) ; 

)  /*  end  print_cl  */ 


void  print_clist (CLIST) 

CONSIDERED_HEAD 


{ 


CONSIDERED_LINK 


•CLIST; 

*CLxCLIST->LINKS ; 


printf ('\n\nConsidered  list 
(THETA=%.21f) :\n\n’,degs(THETA)) ; 
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while  (CL)  { 


print_cl (CL) ; 
CL=CL->NEXT; 

) 

)  /*  end  print_clist  */ 

/ 


**/ 


/*  Sweep  links  are  added  to  the  list  in  order  of  their  THETA  values*/ 


SWEEP.LINK 

{ 


*add_sweep_l ink ( LIST. LINK ) 
SWEEP_LINK  *LIST,  ‘LINK; 

SWEEP_LINK  *TEMP; 


>THETA) ) 


if  (LIST)  { 

TEMP=LIST; 

if  (TEMP->THETA>LINK->THETA)  { 

LINK->NEXT=LIST; 

LIST=LINK;  /*  inserted  as  1st  element  */ 

} 

else  { 

while  ( ( TEMP- >NEXT)£<£,( TEMP- >NEXT->THETA<=L INK - 
TEMP=TEMP->NEXT; 

) 

LINK- >NEXT=TEMP->NEXT ; 

TEMP->NEXT=:LINK; 

)  /*  end  else  */ 

)  /*  end  if  */ 
else 


LIST=LINK;  /*  is  first  element  to  add  to  list  */ 
return  LIST; 

)  /*  end  add_sweep_link  */ 


/*  This  function  scans  through  the  entire  world  model  (W) .  A  sweep  link 
is 

made  for  each  vertex  of  the  model.  The  angle  from  the  observer  (glolaal 
variable)  to  the  vertex  is  calculated  and  used  to  sort  the  links. 

When  e.  Link  is  made,  we  also  inspect  its  ->VERT_EDGE  pointer  to  see 
if  a  'ortical  line  leaves  it.  Calculate_z_coverage  uses  the  height  of 
this  vertical  line  to  determine  coverage  of  the  vertex  along  the  z-eocis. 

Each  sweep  link  has  its  PREV  pointer  assigned  to  indicate  the  link 
which  preceeded  it  in  the  polygon  list.  In  latter  processing  only  sweep 
links  with  a  ccw  relationship  to  this  PREV  link  will  be  considered  as 
visible. 
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Since  we  will  latter  require  all  floors  residing  above  the  observer  and 
all  ceiling  below  them  to  be  visible,  we  inspect  each  polygon  for  these 
properties.  When  a  polygon  satifies  one  of  these,  it's  vertices  are 
processed  a  second  time  in  reverse  order.  This  ensures  that  every  edge 
of  the  polygon  will  swho  up  as  a  ccw  CONSIDERED_LINK. 


SWEEP_LINK  *make_8weep_list (W) 

WORLD  *W; 

{ 

SWEEP_LINK  *SWEEP_LIST=NULL, ‘NEXT.L, *LAST_L. ‘FIRST.L; 
POLYHEDRON  *NEXT_PH; 

POLYGON  *NEXT_PG; 

VERTEX  *NEXT_V.  *LAST_V; 

INSTANCE  *NEXT_I,  *LAST_I; 

NEXT_PH = W- > POLYHEDRON_LI ST ; 
while  (NEXT_PH)  { 

NEXT_I =NEXT_PH - > INSTANCE.LIST ; 
while  (NEXT_I)  { 

NEXT_PG=NEXT_PH- >P0LYG0N_L1ST; 
while  (NEXT_PG)  { 

NEXT_V=NEXT_PG- >VERTEX_LI ST ; 

NEXT_L=make_sweep_l ink { NEXT_PH , NEXT_PG , NEXT_V , NEXT_I , 

NEXT_PG->Z_VALUE) ; 

SWEEP_LIST=add_sweep_link(SWEEP_LIST,NEXT_L) ;  /‘make  and 

add  links*/ 

FIRST_L=NEXT_L; 

LAST_LsNEXT_L; 

NEXT_V=NEXT_V - >NEXT ; 
while  (NEXT_V)  { 

NEXT_L=make_sweep_l ink (NEXT.PH , NEXT_PG, NEXT_V, NEXT_I , 

NEXT_PG- 

>Z_VALUE) ; 

NEXT_L- > PREV=LAST_L ; 

SWEEP_LIST=add_sweep_link (SWEEP_LIST, NEXT_L) ; 
LAST_L=NEXT_L; 

NEXT_V=NEXT_V - >NEXT ; 

)  /*  end  while  •/ 

FIRST_L->PREV=LAST_L;  /*  add  line  which  closes  polygon  */ 
/*  Make  entire  polygon  ccw  so  it  may  be  visible  */ 

if  ( ( ( (NEXT_PG->Z_VALUE+NEXT_I->Z<Z) (NEXT_PG- 

>FLOOR==0) ) I  I 

(  (NEXT_PG->Z_VALUE+NEXT_I->Z>Z)«t«t  (NEXT_PG- 

>FLOORr=l) ) )  1  I 

( (NEXT_PH->OBSTACLE==0 ) && (NEXT_PG- 

>FLOOR==0)))  { 

/*  To  cut  down  on  processing  time  the  above  if  statement  can  be  commented 
out  and  the  below  one  used.  This  has  the  effect  of  assuming  a  model 
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is  con^osed  of  only  large  objects  (observer  doesn't  look  down  or  up  to 
them) . 

We  still  must  make  enclosure  ceiling  visible  since  items  such  as  door  jeun 
ceilings  will  not  always  be  above  the  observe*/ 

/*  if  ( (NEXT_PH->OBSTACLE==0)t£.(NEXT_PG->FLOOR==0) )  {*/ 

NEXT_V=NEXT_PG-  >VER'rEX_L  I  ST  ; 

NEXT_L=make_8weep_l ink ( NEXT_PH , NEXT_PG . NEXT_V , NEXT_I , 

NEXT_PG->Z_VALUE) ; 

if  ( ! ( (NEXT_PH->OBSTACLE==0 ) && (NEXT_PG->FLOOR==0 ) ) )  ( 
NEXT_L->MAX_2=NEXT_L->MIN_Z;  /*take  away  height  if  any*/ 
NEXT_L->CEILINGS==NULL; 

NEXT_L- >UPPER_Z=NEXT_L->Z ; 

) 

FIRST_L=NEXT_L; 

NEXT_V=NEXT_V->NEXT; 
while  (NEXT_V)  { 


LAST_L=make_sweep_l ink (NEXT_PH , NEXT_PG. NEXT_V, NEXT_I , 
>Z_VALUE) ; 


NEXT_PG- 


if  any*/ 


if  ( ! ( (NEXT_PH->OBSTACLE==0)&£.(NEXT_PG->FLOOR==0) ) )  { 

LAST_L->MAX_Z=LAST_L->MIN_Z;  /*take  away  height 

LAST_L - >CEILINGS= =NULL ; 

LAST_L- >UPPER_Z=LAST_L- >Z ; 


NEXT_L->PREV=LAST_L ; 

SWEEP_LIST=add_sweep_link ( SWEEP_LIST, NEXT_L) ; 
NEXT_L»LAST_L; 

NEXT_V=NEXT_V- >NEXT ; 

} 

NEXT_L-  >PREV=:FIRST_L  ; 

SWEEP_LIST=add_sweep_link (SWEEP_LIST, NEXT_L) ; 

) 

NEXT_PG=NEXT_PG->NEXT; 

)  /*  end  while  NEXT_PG*/ 

NEXT_I =NEXT_I - >NEXT ; 

)  /*  end  while  NEXT_I  */ 


NEXT_PH=NEXT_PH - >NEXT ; 

}  /*  end  while  NEXT_PH  */ 
return  SWEEP_LIST; 

)  /*  end  make_sweep_list  */ 


/*  Searches  considered  list  (CL)  .  if  sweep  link  (SLINK)  is  the  2nd  endpoint 
of  an  edge,  that  edge  is  returned  to  complete  its  processing.  If  no 
match  is  found  a  null  pointer  is  returned*/ 

CONSIDERED_LINK  *under_consideration (SLINK, CL) 

SWEEP_LINK  * SLINK; 
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{ 


CONSIDERED_HEAD  *CL; 

CONSIDERED_LINK  *NEXT_CL=CL->LINKS; 


list*/ 


while  (NEXT_CL)  { 
if  (NEXT_CL->SL1==NULL) 

printf ( 'NnWarning  CL  with  no  SLl’); 
if  (NEXT_CL->SL2=ixNULL) 

printf ( •XnWarning  CL  with  no  SL2*); 
if  (NEXT_CL->SL2*=SLINK) { 

return  NEXT_CL;  /*  retrun  ptr  if  in 


) 

else 


NEXT_CL=NEXT_CL->NEXT ; 

) 

return  NEXT_CL;  /*  returns  NULL  if  not  in  list  */ 
)  /•  end  under_consideration  */ 


/*  Determine  the  point  of  intersection  along  CL’s  edge  which  occurs  with 
the  ray  originating  from  the  observer's  position  (X.Y.Z)  along  ANGLE. 
The  distance  to  this  intersection  ios  also  calculated. 


NOTE: 


usage 


Intersection  and  distance  are  returned  by  reference  in  variable 
addresses  INT_X,INT_Y  and  DIST. 

It  is  assumed  an  intersection  does  take  place  (dictated  by 

in  algorithm).*/ 


void  line_ray_intersection (CL, ANGLE, INT_X, INT_Y,DIST) 
CONSIDERED_LINK  *CL; 
double  ANGLE, *1NT_X,*INT_Y, *DIST; 

{ 

double  XX, YY;  /* values  at  intersection  */ 
double  dx,dy;  /*delta  values*/ 
double  M_LINE,H_RAY;  /*slope  of  line  and  ray*/ 
double  B_LINE, B_RAY;  /*y- intercept'*/ 

dy=CL->SL2->Y-CL->SLl->Y; 

dx=CL->SL2->X-CL->SLl->X; 

if  ( (ANGLE==CL->SLl->THETA)t.&(ANGLE==CL->SL2->THETA) )  { 
if  (CL->SL1->DIST<=CL->SL2->DIST)  { 

XX=CL->SL1->X; 

YYxCL->SLl->Y; 

*DIST=CL->SL1->D1ST; 

) 

else  { 

/*col inear  cases*/ 

XX=CL->SL2->X; 
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YY=CL->SL2->Y; 

*DIST=CL->SL2->DIST; 

) 

) 

else  { 

if  ( (ANGLE==90.0) I  I (ANGLE==180.0) )  {  /‘ray  has  no  slope*/ 
XX=X; 

H_LINE=dy/dx; 

YY=M^LINE*XX+(CL->SL1->Y-(H_LINE*CL->SL1->X) ) ; 

) 

else  { 

M_RAY=tan (ANGLE) ; 

B_RAY=Y-M_RAY*X; 

if  (CL->SL1->X==CL->SL2->X)  {  /‘line  has  not 

slope  */ 

XX=CL->SL1->X: 

YY=M_RAY*XX+B_RAY ; 

) 

else  {  /*  both  line  and  ray  have 

a  slope  */ 

M_LINE=dy/dx; 

B_LINE=CL->SL1->Y-M_LINE*CL->SL1->X; 

XX= (B_L1NE-B_RAY> / (M_RAY-M_LINE) ; 

YY=M_RAY  *XX+B_RAY  ; 

)  /*  end  else  */ 

)  /*  end  else  */ 

•DISTstrunc (sqrt (pow(XX'X, 2 . 0) +pow{YY-Y, 2 . 0) ) ) ;  /‘assign 

distance*/ 

)  /*  end  else  */ 

*INT_Xstrunc (XX) ;  /‘assign  x-y  coordinates  of 
intersection*/ 

*INT_Y=trunc(YY) ; 

)  /*  end  line_ray_inter sect ion  */ 


/*  Searches  currently  accepted  lines.  If  L  duplicates  one  of  these,  a  1  is 
returned.  IDuplications  will  naturally  occurs  since  each  vertical  line  is 
common  to  2  edges .  * / 


int  duplicate_vert_line(L,LIST) 

LINE  *L; 

LINE_HEAD  *LIST; 

{ 

int  DUP=0; 

LINE  *NEXT_L=LIST->VLINE_LIST; 


>22)  ) 


while  (NEXT_L)  { 

if  ( (L->Xl=sNEXT_L->Xl)fi.t(L->Yl==NEXT_L->Yl)&St 

(L->Z1==NEXT_L->Z1 ) && (L->Z2==NEXT_L- 
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DUP=1; 

NEXT_L»NEXT_L->NEXT; 

) 

return  DUP; 

)  /•  end  duplic«te_vert_line  •/ 


void  add_vert_line(CL,SL,LIST) 

C0NSIDERED_L1NK  *CL; 

SWEEP_LINK  ‘SL; 

LINE_HEAD  ‘LIST; 

{ 

LINE  *NEW_LINE=(LINE  *)malloc (sizeof (LINE) ) ; 
double  len; 


short*/ 


short*/ 


len=SL->DIST; 

NEW_LINE- >X1 *SL->X ; 

NEW_LINE->Y1=SL->Y; 

NEW_LINE->MODEL_XaSL->X; 

NEW_LINE->MODEL_Y=SL->Y ; 
if  (CL->MIN_Z>»SL->MIN_Z) 

NEW_LINE->Zl=tan(CL->MIN_Z) *len+Z;  /*clipped 


else 

NEW_LINE->Zl=tan(SL->MIN_Z) *len+Z; 

NEW_LINE->X2 sSL- >X ; 

NEW_LINE- >Y2 =SL- >Y ; 
if  (CL->MAX_Z<aSL->MAX_Z) 

NEW_LlNE->Z2xtan ( CL->MAX_Z ) * len+Z ;  / *clipped 


else 


last  vert . 


NEW_LINE->Z2=tan(SL->MAX_Z) *len+Z; 
NEW_L INE- >NEXT=NULL ; 

if  (duplicate_vert_line(NEW_LINE,LIST)==0)  { 
LIST->VERT_LINES-f  + ; 
if  (LIST->VTAIL)  ( 


line*/ 


LIST->VTAIL- >NEXT=NEW_LINE ; 


/*add  as 


else  { 


vertical  line  added  */ 


LIST- >VTAIL=NEW_LINE ; 

) 

LIST->VTAIL=NEW_LINE;  /*  1st 


} 

)  /*  end  if  */ 

else 


LIST->VLINE_LlSTsNEW_LINE ; 


free(NEW_LINE) ; 
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)  /•  end  add_vert_line  */ 


/*  Adds  only  bottom  edge  of  a  considered  link  (CL)  .  Lines  are  only  accepted 
from  their  MIN_SWEEP  angle  to  the  current  sweep  angle  (THETA).*/ 


void  add_line (CL, LIST) 

CONSIDERED_LINK  *CL; 
LINE_HEAD  *LIST; 

{ 


not 


LINE  *NEW_LINE; 

double  IX.IY.DIST; 

/*DIST  req  fro  call  to  intersection  but  value 


used*/ 


/*bottom  line  is  visible  and  not  just  a  single  point*/ 
if  ( (CL->B_VISIBILITY==l)&&(my_abs(CL->MIN_SWEEP-THETA) >0.0001) )  ( 

NEW_LINE=(LINE  * )malloc (sizeof (LINE) ) ; 

NEW_LINE- >NEXT=NULL ; 

LIST->LINES++; 
if  (LIST->TAIL)  { 

LIST->TAIL->NEXT=NEW_LINE;  /*  add  non-vertical 


line*/ 


else  ( 


added  * / 


LIST->TAIL=NEW_LINE; 

) 

LIST->TAIL=NEW_LINE;  /*  1st  non-vertical  line 


} 


LIST- >LINE_LIST=NEW_LINE ; 


/*  find  first  endpoint  to  accept*/ 

line_ray_intersection  (CL,  CL->MIN_SWEEP,  S.IX,  &iy,  S.DIST)  ; 
NEW_LINE->X1=IX; 

NEW_LINE->Y1=IY; 

NEW_LINE->Z1=CL->SL1->Z; 

/*find  second  endpoint*/ 

line_ray_intersectio.»  (CL, THETA,  tlX,  &IY,  JtDIST)  ; 
NEW_LINE->X2=IX; 

NEW_LINE->Y2=IY; 

NEW_LINE->Z2=CL->SL2->Z; 

}  /*  end  if  */ 

CL- >MIN_SWEEP=THETA ; 

)  /*  end  add_line  */ 


/*  This  function  calculates  distances  from  the  observer  along  the  current 
THETA  to  each  edge  on  the  considered  list.  Distances  do  not  account  for 
z  infromation  (height),  but  reflect  straight  line  distance  to  the 
intersection  lying  in  the  x-y  plane.  */ 
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void  calculat«_di8tanc«s (CLIST) 

CONSIDERED.HEAD  ‘CLIST; 


{ 


CONSIDERED_LINK  •NEXT_CL=CLIST->LINKS ; 

double  IX, lY;  /‘pointers  and  values  at  intersection 

double  DIST;  /‘distance  to  intersection  values‘/ 


•/ 


while  (NEXT_CL)  { 

line_ray_intersection(NEXT_CL, THETA,  MX,  StlY.fcDIST)  ; 
NEXT_CL->DIST=DIST; 

NEXT_CL=NEXT_CL- >NEXT ; 

)  /‘  end  while  ‘/ 

)  /‘  end  calculate.distances  •/ 


/‘  When  a  link  is  put  on  the  considered  list,  we  must  determine  how  much  of 
it  is  blocked  from  view  (along  the  z  axis)  and  what  affect  it  has  on 
more  distant  edges. 

Notice  that  case  2  is  not  accounted  for  since  we  are  dealing  with  a 
wire  frame  representation . ‘/ 

void  calculate_visibility_add( CLINK, CLIST, LLIST) 

CONSIDERED_LINK  ‘CLINK; 

CONSIDERED_HEAD  ‘CLIST; 

LINE_HEAD  ‘LLIST; 

{ 

CONSIDERED.LINK  ‘CLsCLINK- >NEXT; 
int  TYPE.OCCLUSION; 


if  (CLIN’K->NEW_VISIBILITY==1)  {  /‘if  visible  it  may  occlude 

others‘/ 

while  (CL)  { 

if  (CL->NEW_VISIBIL1TY==1)  {  /‘can  only  block 

visible  lines*/ 

TYPE_OCCLUS lONsocclus ion ( CLINK , CL ) ; 


/‘totally  occluded*/ 


occluded*/ 


>NEWJ4AX_Z; 

/* 


switch  (TYPE.OCCLUSION)  { 
case  4: 

CL->NEW_VISIBILITy=0; 
CL->NEW_B_VISIBILITY=0 ; 
break ; 

case  3:  /‘bottom 

CL->NEW_B_VISIBILITY=0 ; 
CL- >NEW_MIN_Z=CLINK- 

break ; 

case  2: 
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>NEW_MAX^Z; 

*/ 

/•top  occluded*/ 
>r’«W_MIN_Z; 


CL->NEW_MIN_Z=CLINK- 
break ; 

case  1 : 

CL- >NEW_MAX_Z=CLINK- 
break; 

)  /*end  switch*/ 

)  /*  end  if  */ 

CL=CL->NEXT; 


)  /*  end  while  */ 

)  /*  end  if  */ 

)  /*  end  calculate_visibility_add  */ 


/*  Calculate  the  visibility  of  the  vertical  edge  (if  any)  residing  on  the 
2nd  endpoint  of  a  link  which  is  being  passed  by  the  sweep  (thus  removed 
from  the  considered  list)*/ 

void  calc_vis_remove (CL, CLIST) 

CONSIDERED_LINK  *CL; 

CONSIDERED_HEAD  * CL 1ST; 

{ 

CONSIDERED_LINK  *NEXT_CL=CLIST->LINKS ; 
int  TyPE_OCCLUSION; 

/•now  calc  visibility  bounds  of  SL2's  vertical  line  if  there  is  one*/ 
if  (CL->SL2->V->VERT_EDGE)  { 

while  (  (CL!=NEXT_CL)StSt(CL->NEW_VISIBILITy==l)  )  { 

if  ( CL- >SL2 - >THETA==NEXT_CL- >SL1 - >THETA ) 
TYPE_OCCLUSION=0 ; 

else 

TYPE_OCCLOSION=occlusion (NEXT_CL, CL) ; 
switch  (TYPE_OCCLUSION)  { 
case  4 : 

CL->riEW_VISIBILlTy=0  ; 
break ; 

case  3:  case  2; 

CL->NEW_MIN_Z=NEXT_CL->NEW_MAX_Z ; 
break; 

case  1:  /*top  of  B  occluded*/ 

CL->NEW_MAX_Z=NEXT_CL- >NEW_MIN_Z ; 
break ; 

)  /*end  switch*/ 

NEXT_CL=NEXT_CL- >NEXT ; 

)  /*  end  while  */ 

CL->VISIBILITY=CL->NEW_VISIBILITY; 

CL->MIN_Z=CL->NEW_MIN_Z ; 

CL->MAX_Z=CL->NEV01A3C_Z  ; 

}  /*  end  if  */ 


•  Ise 

CL->V1SIBILITY*0; 

)  /•  •nd  calc_vis_r«inove  */ 


/•  If  visibility  has  been  altered  from  last  time,  we  must  accept  lines 
which 

were  already  visible  and  reset  the  value  of  MIN_SWEEP  to  reflect  where 
along 

the  edge  these  new  values  start.*/ 


int  visibility_changes (CL) 
CONSIDERED_LINK 

{ 


*CL; 


int  CHANGES=0; 

double  EXP_MIN_Z,  EXP_MAX_Z;  /‘expected  coverage  based  on 
perspective*/ 


EXP_MIN_Z=trunc{atan{ (CL->SL1->Z-Z) /CL->DIST) ) ; 
EXP_MAX_Z=trunc(atan( (CL->UPPER_Z-Z) /CL->DIST) ) ; 


) 


if  (CL->VISIB1LITY ! =CL->NEW_VlSIBlLlTy ) 
CHANGES++; 

if  {CL->B_VISIBILITY!=CL->NEW_B_V1SIBILITY) 
CHANGES++; 

i f  ( EXP_MIN_Z ! =CL->NEW_MIN_Z ) 

CHANGES++; 

if  (EXP_MAX_Z!=CL->NEW_MAX_Z) 

CHANGES++ ; 
return  CHANGES; 


void  update_visibility (CLIST, LLIST) 
CONSIDERED_HEAD  *CLIST; 
LINE_HEAD  ‘LLIST; 


{ 


CONSIDERED_LINK  ‘CL=CLIST->LINKS; 


while  (CL)  { 

if  (visibility_changes (CL) ! =0)  { 

if  ( (CL->B_VISIBILITY==1)&&(IN_MAIN) ) 
add_line (CL, LLIST) ; 
CL->VISIBILITY=CL->NEW_VISIBILITY; 
CL->B_VlSlBILITy=CL->NEW_B_VISIBILITy; 
CL->MIN_Z=CL->NEW_>dIN_Z  ; 
CL->MAX_Z=CL->NEW_MAX_Z ; 

CL->MIN_SWEEP=THETA;  /‘values  only  affect 
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CL=CL->NEXT; 


/*  Visibility  must  be  periodically  recomputed  to  account  for  the  effects 
of 

perspective  as  the  sweep  progresses  around  360  degrees.*/ 

void  recompute_visibility (CLIST.LLIST) 

CONSIDERED_HEAD  * CL 1ST; 

LINE_HEAD  ‘LLIST; 

{ 

CONSIDERED_LINK  *CL-CLIST->LINKS; 

calc_current_2_coverage (CLIST) ;  /*will  change  due  to 

perspective*/ 

while  (CL)  {  /*add  each  lin)t  again*/ 

calculate_visibility_add (CL, CLIST, LLIST) ; 
CL=CL->NEXT; 

) 

update_visitility (CLIST, LLIST) ;  /*see  if  changes  occured*/ 
)  /*  end  recompute_visiLility  */ 


/*  Add  a  new  lin);  to  the  considered  list  (sorted  by  distance  from  observer 
in  the  x-y  plane)  .  If  a  vertical  edge  resides  on  the  linlcs  first  endpoint 
accept  it  based  on  the  edges  computed  visibility*/ 

void  add_considered_lin)t  (CL,  CLIST,  LLIST) 

CONSIDERED.LINK  *CL; 

CONSIDERED_HEAD  *CLIST; 

LINE_HEAD  *LLIST; 


>DIST) )  { 


CONSIDERED.LINK  *NEXT_CL=CLIST->LINKS ; 

if  ( CLIST- >LINKS)  {/*recalc  distances  for  insert*/ 
calculate_distances (CLIST) ; 
if  (CL->DIST<NEXT_CL->DIST)  { 

CL->NEXT=CLIST->LINKS ; 

CLIST->LINKS=CL;/*add  as  1st  element*/ 

)  /*  end  if  */ 

else  { 

while  ( (NEXT_CL->NEXT) && (NEXT_CL->NEXT->D1ST<CL- 
NEXT_CL=NEXT_CL->NEXT; 


/*]ceep  ones  leaning  in  towards  camera  1st  on  list*/ 

while  ( ( (NEXT_CL->NEXT) && (NEXT_CL->NEXT- 

>DIST==CL->DIST) ) && 
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>SL2 ) ) ) 


(ccw2 (CL->SL1 . CL->SL2 , NEXT_CL->NEXT- 
NEXT_CLxNEXT_CL - >NEXT ; 


CL->NEXTxNEXT_CL->NEXT; 

NEXT_CL- >NEXT=CL ; 

)  /*  end  else  •/ 

reconq?ute_visibility (CLIST, LLIST) ; 

)  /*  end  if  */ 

else  ( 

CLIST->LlNKS=CL;/*lst  element  added  to  null  list*/ 
CL->VISIBILITY=1;  /‘so  must  be  visible*/ 
CL->B_VISIBILITY=1;  /*ao  must  be  visible*/ 

) 

if  ( (lN_HMN)S.t{  ( (CL->VISlBILlTY==l)tt{CL->MIN_Z<CL->MAX_Z)  ) 
&& (CL->SL1->V->VERT_EDGE) ) ) 
add_vert_l ine (CL, CL->SL1, LLIST) ; 

}  /*  end  add_considered_link  */ 


/*  Remove  a  CL  from  the  list*/ 


void  remove_cl (CL, CLIST) 

CONSIDERED_LINK 

CONSIDERED_HEAD 


{ 


CONSIDERED_LINK 


*CL; 

*CLIST; 

*NEXT_CLxCLIST- >LINKS ; 


if  (CL==NEXT_CL)  {  /*  removing  1st  link  */ 

CLIST- >LINKS*NEXT_CL->NEXT; 
free(CL);  /*deallocate  memory*/ 

) 

else  { 

while  ( (NEXT_CL->NEXT) && (NEXT_CL->NEXT ! =CL) )  ( 
NEXT_CL=NEXT_CL- >NEXT ; 

) 

if  (NEXT_CL->NEXT)  { 

NEXT_CL->NEXT=CL->NEXT; 
free(CL);  /*deallocate  memory*/ 

) 

)  /*  end  else  */ 

)  /*  end  remove_cl  */ 


/*  The  sweep  has  progresses  to  the  end  of  link  CL.  We  need  to  inspect  the 
visibility  and  accept  both  the  bottom  edge  and  vertical  line  (at  2nd 
endpoint)  if  required. 

Once  this  is  done,  visibility  of  the  entire  considered  list  (CLIST) 
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must  b«  reccHnputed  to  account  for  perspective  and  the  deleted  edge*/ 

void  complete_line(CL,CLIST,LLI£T) 

CONSIDERED_LINK  *CL; 

CONSIDERED.HEAD  ‘CLIST; 

LINE.HEAD  ‘LLIST; 

{ 

LINE  *L; 

if  ( (CL->VISIBILITY==1 ) &C.  (CL->B_VISIBILITY==1 ) ) 
add_line(CL,LLIST) ;  /‘also  checks  for  and  adds  right  vert 

line*/ 

calculate_distances (CLIST) ; 
calc_current_z_coverage (CLIST) ; 
calc_vis_reiDove  (CL, CLIST) ; 

if  ( (CL->SL2->V->VERT_EDGE)&&(CL->VISIBILITY==1) ) 
add^vert_line (CL,CL->SL2,LLIST) ; 
remove_cl (CL, CLIST) ;  /*if  not  visible  no  changes  needed 
before  removal*/ 

recompute_visibility (CLIST, LLIST) ; 

)  /*  end  complete_line  */ 


/*  These  occlusion  codes  applie  if  both  links  Isegin  at  the  same  vertex 
in  the  model.*/ 

int  overlay_occlusion(F,B) 

CONSIDERED_LINK  *F,  *B; 

{ 

int  TYPEsO;  /*default  is  no  occlusion  occurs*/ 

if  (F->NEW_MIN_Z<=B->NEW_MIN_Z)  { 

if  (F->NEW_JMAX_Z>=B->NEW_MAX_Z) 

TYPE=4;  /*  totally  occluded*/ 

else  { 

if  (F->NEW_MAX_Z>=B->NEW_MIN_Z) 

TYPE=3;  /*l3ottom  of  B  occluded*/ 


)  /*  end  if  */ 
else  { 

if  (F->NEW_NAX_Z<B->NEW_J1AX_Z) 

TyPE=2;  /*middle  prtion  of  B  occluded*/ 

else  { 

if  (F->NEW_NIN_Z<=B->NEW_HAX_Z) 

TYPE=1;  /*top  of  B  occluded*/ 

) 

)  /*  end  else  */ 

/*  otherwise  there  is  no  occlusion  */ 
return  TYPE; 

)  /*  end  overlay_occlusion  */ 
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/*  The  type  of  occlusion  imposed  upon  the  back  edge  (B)  by  the  front  edge 
(F) 

is  determined:  return  value  is  0,1,2, 3,  or  4  */ 

int  occlusion (F,B) 

CONSIDERED_LINK  *F,  *B; 

{ 

int  TYPEsO;  /‘default  is  no  occlusion  occurs*/ 

/*No  occlusion  if  edges  fall  on  the  same  plane  or  are  end-to-end*/ 
if  ( ( (F->SL1->THETA==B->SL2->THETA) I  I (F->SL2->THETA==B->SL1->THETA) )  I  I 
( (F->MIN_Z==F->MAX_Z) I  I (colinear (F, B) ) ) ) 

TYPEsO; 
else  ( 

if  ( ( <F->SL1->D1ST==B->SL1->DIST)S.&(F->SL1->THETA==B->SL1->THETA) ) 
S.S.(B->UPPER_Z<9999.0)  ) 

TYPE=overlay_occlusion(F,  B) ; 

else  { 

if  (F->NEW_WIN_Z<B->NEW_MIN_Z)  { 

if  (F->NEW_MAX_Z>B->NEW_MAX_Z) 

TYPE=4;  /*  totally  occluded*/ 

else  ( 

if  (F->NEW_MAX_Z>B->NEW_MIN_Z) 

TYPE=3;  /‘bottom  of  B  occluded*/ 

) 

)  /*  end  if  */ 
else  { 

if  (F->NEW_MAX_Z<B->NEW_MAX_Z) 

TYPE=2;  /‘middle  prtion  of  B  occluded*/ 

else  { 

if  (F->NEW_>1IN_Z<B->NEW_MAX_Z) 

TYPE=1;  /*top  of  B  occluded*/ 

) 

)  /*  end  else  */ 

)  /*  end  else  */ 

)  /*  end  else  */ 

/*  otherwise  there  is  no  occlusion  */ 
return  TYPE; 

)  /*  end  occlusion  */ 


/*  This  is  the  primary  function  which  will  be  called  from  outside  this 
file. 

A  list  of  sweep  links  is  constructed  based  on  the  model  (W)  and  the 
observer ' s 

position  (EYE_X,EYE_Y,EYE_Z) . 

Next  edges  straddling  0  degrees  are  placed  on  the  considered  list  (if 
they 

are  ccw) .  Then  main  processing  begins  and  each  sweep  link  and  its 
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predicessor 

is  inspected.  If  the  circuit  from  observer  to  SL  to  prev(SL)  is  ccw, 

the 

SL's  are  put  into  a  considered  link  (CL)  and  added  to  the  considered  list 
(CLIST) . 

As  the  sweep  progresses  throught  the  sweep  links:  visibility  is  updated, 
lines  are  accepted,  and  edges  are  removed  from  CLIST  (as  they  are  passed)  . 

OUTPUT:  LINE_LIST  structure  pointing  to  2  list  of  lines 

(vertical  and  non-vertical  accepted  lines) 


*/ 

LINE_HEAD  *conduct_visibility_sweep(W, EYE_X, EyE_Y, EYE_Z) 

WORLD  *W; 

double  EYE_X , EYE_Y , EYE_Z ; 

{ 

SWEEP_LINK  *NEXT_SL,  •SWEEP_L1ST=NULL; 

CONSIDERED_LINK  *CL,  •PAST_CL; 

CONSIDERED_HEAD  *CLlST=make_considered_head ( ) ; 

LINE_HEAD  *LINE_LIST=make_line_head ( ) ; 
int  STRADDLERS=0; 

IN_MAIN=0;  /*still  processing  straddlers*/ 

X=EYE_X; 

Y=EYE_Y; 

Z=EYE_Z; 

SWEEP_LIST=make_sweep_list (W) ; 

NEXT_SL=SWEEP_LIST ; 

/*  Add  all  visible  straddlers*/ 
while  (NEXT_SL)  { 

THETA=NEXT_SL - >THETA ; 

if  ( (ccw (NEXT_SL,NEXT_SL->PREV )==!)&& 

(NEXT_SL->THETA>NEXT_SL->PREV->THETA) )  { 
CL=make_considered_link {NEXT_SL) ; 

add_considered_link (CL, CLIST, LINE_LIST) ; 

CL->MIN_SWEEP=0 . 0 ; 

STRADDLERS=1  ; 

) 

NEXT_SL=NEXT_SL->NEXT; 

)  /*  end  while  */ 

NEXT_SL=SWEEP_LI ST ; 

THETA=0 . 0 ; 

IN_>1AIN=1; 

/*  Process  all  of  sweep  list*/ 
while  (NEXT_SL)  { 

THETA=NEXT_SL- >THETA ; 
while 

( PAST_CL=under_consideration (NEXT_SL, CLIST) )  { 
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complete_line ( PAST_CL, CLIST, LINE_LIST) ; 

) 

if  (ccw(NEXT_SL,NEXT_SL->PREV)==l)  { 

CL=inake_consider*d_link(NEXT_SL)  ; 


add_consid«red_link (CL, CLIST, LINE_LIST) ; 

) 

NEXT_SL»NEXT_SL->NEXT ; 

)  /*  end  while  */ 

if  (STRADDLERS)  {  /*  have  lines  crossing  ZERO  degrees  */ 

THETAaO.O; 

calculate_distances (CLIST) ; 

CL=CLIST->LINKS; 
while  (CL)  ( 

if  ( (CL->VISlBILITy==l)fc&(CL- 


>B_VISIBILITY==1) ) 


add_line (CL, LINE_LIST) 

CL=CL->NEXT: 


) 

)  /*  end  if  */ 

free_clist (CLIST) ; 
free_sweep_list (SWEEP_LIST) ; 
return  LINE.LIST; 

)  /*  end  conduct_visibility_sweep  •/ 
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/ 


FILENAME:  2d-<-.h 

AUTHOR:  LT  Jeunes  Stein 

CONTENTS:  2d-f  model  support  tools  (for  building,  displaying,  searching, 
and  deallocating  a  model) 

DATE:  Mar  1992 

COMMENTS:  A  'world'  consists  of  a  list  of  polyhedrons  (PH)  Each  PH  is  in 
turn  a  list  of  polygons  (PG)  .  Each  PG  is  a  list  of  VERTICIES  which  contain 
the  X,Y,  and  Z  coordinates  of  that  point  in  the  world. 

File  5th. h  is  an  exanple  construction  file  which  uses  these  functions  to 
build  a  model  of  the  1st  half  of  Spanagel  Hall's  5th  floor. 


/ 


/*  constants  */ 

#define  PI  3.141592653589793 

#define  MAX_LEN  30 

/*  typedefs:  Define  structures  to  be  used  for  representing  a  3-d  world  •/ 

typedef  struct  vertex  { 
float  X,Y; 
struct  vertex 
♦NEXT,  *PREV, 

*VERr_EDGE; 

)  VERTEX; 

/*  WHERE:  VERT_EDGE  =  pointer  to  upper  vertex  of  vertical  edge 

. . - . —  */ 


typedef  struct  poly_lin)i  { 
struct  polygon  *REF_POLY; 
struct  poly_lin)t  'NEXT,  *PREV; 

)  POLY_LINK; 

/* - - - - */ 

typedef  struct  polygon  ( 

int  DEGREE,  C_DEGREE,  FLOOR,  CONVEX; 
float  Z_VALUE; 

VERTEX  *VERTEX_LIST; 

P0LY_LINK  *CEILING_LIST; 
struct  polygon 
♦NEXT,  ♦PREV; 

}  POLYGON; 
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/*  WHERE: 


DEGREE  s  #  of  vertices 

FLOOR.  CONVEX  =  booleans 

Z_VALUE  =  local  Z  position  poly  located  at 
CEILING_LIST,  FLOOR_LIST  =  list  of  associated 

poly ■ s 


*/ 


typedef  struct  instance  { 
char  NAME[MAX_LEN] ; 
float  X.  Y.  Z.  ROTATION, 
PIVOT_X,  PIVOT.Y; 
struct  instance  ‘NEXT,  ‘PREV; 
)  INSTANCE; 


/*  WHERE:  NAME  =  something  like  ‘rmSOl* 

X,  Y,  Z  =  position  to  instantiate  PH  into  world 
ROTATION  s  degrees  to  rot  about  Z  axis 

. . . */ 


typedef  struct  polyhedron  { 
char  CLASS tMAX_LEN] ; 

int  DEGREE,  I_DEGREE,  OBSTACLE,  FIXED; 

POLYGON  *POLYGON_LIST;  /‘ordered  by  Z  value*/ 
INSTANCE  *INSTANCE_LIST;  /‘ordered  by  Z  value*/ 
struct  polyhedron  ‘NEXT,  ‘PREV; 

)  POLYHEDRON; 


/*  WHERE; 


polygons 

world 


CLASS  -  general  name  like  'door' 

DEGREE  X  #  of  polygons 

OBSTACLE  and  FIXED  =  booleans 

CEILING_LIST,  FLOOR.LIST  =  list  comprise  all 

INSTANCE_LIST  =  all  tranformations  of  object  into 


*/ 


typedef  struct  world  { 
char  NAME[MAX_LEN] ; 
int  DEGREE; 

POLYHEDRON  *POLYHEDRON_LIST; 

)  WORLD; 

/*  WHERE:  NAME  s  label  for  world 

DEGREE  s  number  of  object  representations 
POLYHEDRON_LIST  points  to  them 
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/ 


/ 


The  following  routines  are  called  to  allocate  memory  for  a  structure 
(WORLD,  POLYHEDRON.  POLYGON,  or  VERTEX)  .  Pointers  are  initialized  to  NULL 
and  the  DEGREE  field  is  set  to  0- 


. . 

WORLD  •create_world( ) 

{ 

WORLD  *W; 
int  i; 

/•  allocate  memory  for  a  world  */ 

if((W  =  (WORLD  *)malloc(sizeof (WORLD) ) )  a=  NULL)  { 

printf  ( "Sncannot  create  a  worldXn*).- 

) 

/•  initialize  fields  */ 

W->DEGREE  =  0; 

W->POLYHEDRON_LIST  =  NULL; 
for  {i=0;  i<MAX_LEN;  ++i)  ( 

W->NAME[i)  =  '  •  ; 

} 

return (W) ; 


POLYGON  *create_polygon ( ) 

{ 

POLYGON  *P; 

/*  allocate  memory  for  a  polygon  */ 

if((P  =  (POLYGON  *)malloc(sizeof (POLYGON) ) )  ==  NULL)  { 
printf ( • \cannot  create  a  polygon*); 

) 

/*  initialize  fields  */ 

P->DEGREE  =  0; 

P->Z_VALUE*  0.0; 

P->VERTEX_LIST  =  NULL; 

P->CEIL1NG_LIST=  NULL; 

P->NEXT  =  NULL; 

P->PREV  =  NULL; 
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return (P) ; 


INSTANCE  *create_instance ( ) 

{ 

INSTANCE  *1; 
int  i; 

I«  (INSTANCE  *)malloc(Bizeof (INSTANCE) ) ; 
for  (isO;  i<MAX_L£N;  ^fi)  ( 

I->NAMEIi]='  •; 

} 

I-'*NEXT  =  NULL; 

I->PREV  -  NULL; 
return  I; 


. . - . — . . */ 


POLY_LINK  *create_poly_link( )  { 

POLY_LINK  *P; 

P= (POLY_LINK  *)inalloc ;si2eof (POLY_LINK) ) ; 
P->REF_POLY  =  NULL; 

P->NEXT  =  NULL; 

P->PREV  a  NULL; 
return  P; 


/• . - . - . */ 

POLYHEDRON  *create_polyhedron ( ) 

{ 

POLYHEDRON  ‘P; 
int  i; 

Pa (POLYHEDRON  *)inalloc (sizeof (POLYHEDRON) ) ; 
for  (i=0;  i<MAX_LEN;  +-*-i)  { 

P->CLASS[i]a'  •; 

) 

P->DEGREEaO ; 

P->POLYGON_LISTaNULL; 

P->NEXTaNULL; 

P->PREV=NULL; 

P->INSTANClL.LISTaNULL; 
return  P; 

)  /*  end  create_polyhedron  */ 
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VERTEX  •create_vertex ( ) 

{ 

VERTEX  *V; 

V»  (VERTEX  *)itvalloc(8izeo£  (VERTEX) )  ; 
V->NEXT=NULL; 

V->PREV  s  NULL; 

V->  VERT_EDGE  =NULL; 
return  V; 


The  following  routines  are  used  for  memory  deallocation.  Each  type  of 
list  is  stepped  through  to  free  it*s  component  structures.  Higher  level 
structures  call  the  free  routine  for  the  next  lower  level  to  deallocate 
side  lists  (i.e.  free_world  calls  free_polyhedron) . 


/ 


void  free_pg(PG) 

POLYGON  *PG; 

{ 

VERTEX  *NEXT_V,  *TRASH; 

POLY.LINK  *NEXT_LINK,  *TRASH2 ; 

NEXT_V=PG->VERTEX_LIST;  /‘free  vertex  list*/ 
while  (NEXT_V)  { 

TRASH=NEXT_V; 

NEXT_V=NEXT_V- >NEXT ; 
free (TRASH) ; 

) 

NEXT_LINK=PG->CEILING_LIST; 

while  (NEXT_LINK)  {  /*free  lin)cs  used  to  reference  ceilings*/ 

TRASH2  =NEXT_LINK ; 

NEXT_LINK=NEXT_LINK->NEXT ; 
free(TRA5H2) ; 

) 

free(PG);  /*free  parent  polygon  structure  */ 

}  /*  end  free_pg  */ 


void  fr«e_ph(PH) 

POLYHEDRON  *PH; 

{ 

POLYGON  *NEXT_PG,  ‘TRASH; 

INSTANCE  ‘NEXT.I,  •TRASH2; 

NEXT_PG=PH->POLYGON_LIST; 

while  (NEXT_PG)  {  /‘free  the  list  of  polygons*/ 

TRASH=NEXT_PG; 

NEXT_PG*NEXT_PG- >NEXT ; 
free_pg (TRASH) ; 

) 

NEXT_1  »  PH->INSTANCE_LIST; 

while (NEXT_I)  {  /‘free  the  list  of  instances‘/ 

TRASH2=  NEXT_.l; 

NEXT_I*  NEXT_I->NEXT; 
free{TRASH2) ; 

) 

free{PH);  /*  release  parent  structure  ‘/ 

)  /*  end  free_ph  ‘/ 


/‘ - - - - - - — - - */ 

void  free_world(W) 

WORLD  ‘W; 

{ 

POLYHEDRON  ‘NEXT.PH,  ‘TRASH; 
if  (W)  ( 

NEXT_PHaW->POLYHEDRON_LIST; 

while  (NEXT_PH)  {  /‘free  the  list  of  polyhedra‘/ 

TRASH=NEXT_PH; 

NEXT_PH=NEXT_PH->NEXT; 
free_ph (TRASH) ; 

) 

) 

free (W) ; 

)  /‘  end  free_world  ‘/ 


/ 


The  next  group  of  functions  is  used  to  display  the  world.  A  single 
polygon,  a  single  polyhedron,  or  the  entire  world  c^u>  be  displayed. 
Display  is  in  text  format  to  the  standard  output  device. 


/ 
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void  display_pg (PG) 

POLYGON  *PG; 

{ 

POLYGON  *NEXT_PG; 

POLY_LINK  *NEXT_C; 

VERTEX  *NEXT_V; 

int  V_NUM=1.  PRINTEDsO; 

printf CXnDEGREE:  %d  FLOOR:  %d  Convex:  %d  * , PG->DEGREE, PG->FLOOR, 
PG->CONVEX) ; 

printfCXnZ  *  %  .2£ :  \n* .  PG->Z_VALUE)  ; 

NEXT_V»PG- >VERTEX_LIST ; 
while  {NEXT_V)  { 

if  (PRINTED>3)  {  /•  three  vertices  per  line*/ 

printf ( ■ \nV#%d (%.2f.%.2f)  *, V_NUM, NEXT_V->X, NEXT_V->Y) ; 
PRINTED=1; 

) 

else  { 

printf (•V#%d(%.2f,%.2f)  • . V_NUM.NEXT_V->X,NEXT_V->Y) ; 

PRINTED++ ; 

) 

NEXT_V=NEXT_V- >NEXT ; 

V_NUM++; 

)  /*end  while  */ 
if  (PG->FLOOR==l) 

printf ( 'VnAssociated  ceilings  (%d) :  * , PG->C_DEGREE) ; 

NEXT_C=  PG->CEILING_LIST; 

)  /*  end  display_pg  */ 


. . . 


void  display_ph(PH) 

POLYHEDRON  *PH; 

{ 

POLYGON  *NEXT_PG; 

int  PG_NUM , F_CNT= 1 , C_CNT= 1 , I_CNT= 1 ; 
char  duirany; 

INSTANCE  *NEXT_I; 

printf CXnPOLYHEDRON  (%s):\n  Obstacle:  %d  Fixed;  %d  \n*, 
PH->CLASS, PH->OBSTACLE. PH->FIXED) ; 
printf (■XnComponent  polygons  (%d):\n  “ , PH->DEGREE) ; 

NEXT_PG=PH - >POLYGON_LIST ; 
printf { "XnXnList  of  floors;*); 
while  (NEXT_PG)  { 

if  {NEXT_PG->FLOOR==l)  { 

printf CXnNnFLOOR#  %d  '.F.CNT); 

display_pg(NEXT_PG) ;  /*display  floor  polygons*/ 

F_CNT-f+ ; 
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)  /•  end  if  •/ 

NEXT_PG«NEXT_PG- >NEXT ; 

)  /*  end  while  */ 

NEXT_PG*PH - >POLYGON_LI ST ; 
printf ( • \n\nList  of  ceilings: *); 
while  {NEXT_PG)  { 

if  (NEXT_PG->FLOOR*=0)  { 

printf CXnXnCEILING  «  %d  •,C_CNT); 

di8play_pg(NEXT_PG) ;  /“display  ceilings*/ 

C_CNT++; 

)  /*  end  if  •/ 

NEXT_PG*NEXT_PG- >NEXT; 

)  /*  end  while  •/ 

printf ( •\n\nThe  following  instantiations  of  this  polyhedron  exist:*); 
f  f lush ( stdout ) ; 
if  (PHssNULL)  { 

printf (• \n\ndereferencing  null  pointer  in  display_ph\n\n*); 
f flush (stdout ) ; 

) 

NEXT_I =PH- > INSTANCE_LIST ; 
while (NEXT_1)  { 

printf (■ \n\nlnstance  #%d  (%s) :  * . I_CNT, NEXT_I->NAME) ; 
f flush  ( s*-dout )  ; 

printf  CSnLocation:  (% .2f ,  % .2f . % .2f ) * . NEXT_I->X, NEXT_I->Y, NEXT_I->2) 
f flush (stdout) ; 

printf ( 'Rotated:  %.2f  degrees  about  point:  (% . 2f , % .2f ) \n* , 

NEXT_I->ROTATION, NEXT_I->PIVOT_X, NEXT_I ->PIVOT_Y ) ; 
ff lush (stdout) ; 

1_CNT++; 

NEXT_I *NEXT_I - >NEXT ; 

)  /•  end  while  */ 

)  /*  end  di8i.lay_ph  •/ 


/* 


/ 


void  display_world(W) 

WORLD  'W; 

{ 

POLYHEDRON  *PH; 

P0LY(30N  *PG; 
int  NUH_PH=1; 

if  (W)  ( 

printf ( *\nWorld  Name:  %s* , W->NAME) ; 

printf CXnXnWorld  ha8:\n  %d  POLYHEDRONSNn  * , W->DEGREE) ; 

PH»W->POLYHEDRON_LIST; 

while  (PH)  { 

printf v*\n\nPH  #%d  \n*,NUM_PH); 
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NUMLPH++; 
di8play_ph ( PH ) ; 
PHaPH->NEXT; 


) 

)  /•  end  if  */ 

)  /*  end  display  world  */ 


The  following  functions  are  used  by  the  construction  file 
to  add  structures  (i.e.-  POLYHEDRON,  POLYGON,  VERTEX,  and  INSTANCE) 
and  associations  (i.e.-  vertical  edges  and  f loor->ceiling  associations) 
to  a  world. 


/ 


void  add_edge(Vl, V2) 

VERTEX  *V1,  *V2;  /* lower  and  upper  vertices  of  edge*/ 

{ 

if  (V1->VERT_EDGE) 

printf ( ■ \nWarning  reassignment  of  vertical  edge  attempted!!!*) 
else 

V1->VERT_EDGE  =  V2; 

)  /*  end  add_edge  •/ 


/**************** . * . . . **...*.**/ 

void  add_ceiling (PG, C) 

POLYGON  *PG,  *C;  /‘floor  and  its  new  ceiling*/ 

{ 

POLY_LINK  *NEW_C, *NEXT_C; 

int  FOUND=0; 

if  (PG->CEILING_LIST)  { 

NEXT_C=  PG->CEILING_LIST; 
if  (NEXT_C->REF_POLY==C) 

FOUNDS 1; 
else 

while  (NEXT_C->NEXT)  { 

if  (NEXT_C->NEXT->REF_POLY==C) 

FOUNDsl; 

NEXT_C=NEXT_C- >NEXT ; 

)  /*  end  while  */ 
if  (FOUND==0)  { 

NEW_C=create_poly_linIc( ) ;  /‘link  onto  end  of  list*/ 
NEW_C->REF_POLY=C ; 

NEW_C->PREV=NEXT_C ; 

NEXT_C->NEXT=NEW_C ; 

PG->C_DEGREE++ ; 

)  /*  end  if  */ 


else 

printf ( •\nWarning  -  atten^ted  to  add  ceiling  which  exists*); 
)  /*  end  if  */ 
else  ( 

NEW_C=create_poly_link( ) ;  /‘adding  1st  ceiling  to  list*/ 
NEW_C->REF_POLy=C ; 

PG->CEILING_LIST=NEW_C ; 

PG->C_DEGREE+-4.  ; 

)  /*  end  else  */ 

)  /*  end  add_ceiling  */ 


X.Y.Z  is  the  position  in  the  parent  world  at  which  the  pivot  point 
is  to  be  placed. 

PIVOT_X  and  PIVOT_y  specify  th  local  coordinates  (in  POLYHEDRON)  of 
the  objects  pivot  point. 

ROT  is  the  number  of  degrees  the  object  should  be  rotated  a)30ut  this 
pivot  point . 


/ 


void  *add_instance (NAME, LEN, PH. X, Y, Z, PIVOT_X, PIVOT_Y, ROT) 

POLYHEDRON  *PH; 

float  X , Y , Z , PIVOT_X , PI VOT.Y , ROT ; 

char  NAMEIJ •  /‘label  for  instance  and  number  of  characters  in 
label*/ 

int  LEN; 

{ 

INSTANCE  ‘I , ‘TEMP_I , ‘NEXT_I ; 
int  i  ; 

I=create_instance ( ) ;  /‘allocate  and  initialize  memory*/ 
for  (i=0;i<=LEN;++i)  { 

I->NAME[i]=NAME[i] ; 

) 

I->X=X; 

1->Y=Y; 

I->Z=Z; 

I ->PIVOT_X=PIVOT_X ; 

I ->PIVOT_Y=PIVOT_y ; 

I - >ROTATIONxROT ; 

/‘order  by  z*/ 

if  (PH->INSTANCE_LIST==NULL)  { 

PH->INSTANCE_LIST=I ; 

) 

else  { 

NEXT_I =PH-> INSTANCE_LIST ; 
if  (Z<=NEXT_1->Z)  ( 

I->NEXT=NEXT_I; 
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NEXT_1->PREV=I;  /•  add  to  head  of  list*/ 

PH->INSTANCE_LIST=I  ; 

)  /*  end  if  */ 
else  { 

while  (NEXT_I->NEXT«.S.NEXT_I->NEXT->Z<2)  { 

NEXT_IaNEXT_I->NEXT;  /*scan  to  insertion  point*/ 

) 

if  (NEXT_I->NEXT)  { 

I->NEXT=NEXT_I->NEXT;  /-add  to  middle  of  list*/ 
I->PREVxNEXT_I ; 

NEXT_I->NEXT=I; 

I->NEXT->PREV=I; 

)  /*  end  if  */ 
else  { 

I->PREV=NEXT_I;  /*add  as  last  instance*/ 
NEXT_I->NEXT=I; 

)  /*  end  else  */ 

)  /*  end  else  */ 

)  /*  end  else  */ 

PH->I_DEGREE++;  /*keep  track  of  the  number  of  instances*/ 

}  /*  end  add_instance  */ 


/ 


The  remaining  add  functions  create  and  add  structures  to  the  world. 
Pointers  to  each  newly  added  structure  are  returned  to  the  caller  for 
future  use. 

**•*************************************************•***************/ 


VERTEX  *add_vertex{PG,X,y) 

POLYGON  *PG;  /*  parent  polygon  to  add  vertex  to*/ 
float  X,Y;  /* local  coordinates  of  vertex*/ 

{ 

VERTEX  *V,  *NEXT_V; 

V=create_vertex ( ) ; 

V->X=X; 

V->Y=Y; 

if  (PG->VERTEX_LIST==NULL) 

PG->VERTEX_LIST=V; 
else  { 

NEXTJVx PG - > VERTEX_L I ST ; 
while  (NEXT_V->NEXT)  { 

NEXT_V*NEXT,V->NEXT;  /*  scan  to  end  of  list  */ 

) 

NEXT_V->NEXT=V;  /*  add  to  end  of  list  to  retain  order  added*/ 
V->PREV=NEXT_V; 

)  /*  end  else  */ 
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PG->DEGREE-*^-»  ; 
return  V; 

)  /•  end  add_v«rt«x  */ 


. . - . . 


POLYGON  *add_pg ( PH , Z , FLOOR . CONVEX ) 

POLYHEDRON  ‘PH;  /'parent  structure*/ 

float  Z;  /'height  in  local  coordinates*/ 

int  FLOOR, CONVEX;  /'boolean  values*/ 

{ 

POLYGON  *PG, 'NEXT^PG; 

PG=create_polygon ( ) ; 

PG->Z_VALUE=Z; 

PG- >FLOOR=FLOOR ; 

PG- >CONVEX=CONVEX ; 

if  (PH->POLYGON_LISTa=NULL)  /'sorted  by  Z  height*/ 
PH->POLYGON_LIST=PG; 
else  { 

NEXT_PGx  PH - >  POLYGON_LI ST ; 

if  (Z<NEXT_PG->2_VALUE)  {  /'put  at  head  of  list*/ 

NEXT.PG- >PREV=PG ; 

PG- >NEXT*NEXT_PG ; 

PH->POLYGON_LIST=PG; 

)  /*  end  if  */ 
else  ( 

while  ( (NEXT_PG->NEXT)&&(NEXT_PG->NEXT->Z_VALUE>Z) )  { 
NEXT_PG=NEXT_PG->NEXT; 

) 

if  (NEXT_PG->NEXT)  { 

PG->NEXT=NEXT_PG->NEXT;  /*  put  in  middle  of  list  */ 
PG- >PREV=NEXT_PG ; 

NEXT_PG  -  >NEXT=  PG  ; 

PG-->NEXT->PREV=PG; 

)  /*  end  if  */ 
else  ( 

NEXT_PG->NEXTePG;  /*  put  at  end  of  list  */ 
PG->PREV*NEXT_PG ; 

)  /*  end  else  */ 

}  /*  end  else  */ 

)  /*  end  else  */ 

PH->DEGREE+-f  ; 
return  PG; 

)  /*  end  add_pg  */ 


/* . - . */ 
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POLYHEDRON  *addj>h ( CLASS ,  LQI. W,  FIXED.  OBSTACLE) 
char  CLASSU:  /*class  name*/ 

WORLD  *W;  /‘world  to  add  polyhedron  to*/ 

int  FIXED, OBSTACLE, LEN;  /*  2  booleans  and  the  length  of  CLASS*/ 

{ 

POLYHEDRON  *PH, *NEXT_PH; 
int  i; 

PH=create_polyhedron  ( ) 
for  (isO; i<sLEN;4^-f i)  { 

PH->CLASS [ i ] sCLASS [ i ] ; 

) 

PH->FIXED=FIXED; 

PH - >OBSTACLE=OBSTACLE ; 
if  {W->POLYHEDRON_LIST==NULL) 

W- >POLYHEDRON_LIST=PH ; 
else  { 

NEXT_PH=W->POLYHEDRON_LIST; 
while  (NEXT_PH->NEXT)  { 

NEXT_PH=NEXT_PH->NEXT;  /‘scan  to  end  of  list*/ 

) 

NEXT_PH - >NEXT=  PH ; 

PH->PREV=NEXT_PH ; 

}  /*  end  else  */ 

W->DEGREE++ ; 
return  PH; 

)  /*  end  add_ph  */ 


. . . 


WORLD  *add_w<  l Id (NAME, LEN) 

char  NAME[];  /*label  and  its  length*/ 
int  LEN; 

{ 

WORLD  *W; 
int  i; 

W=create_world( ) ; 

for  (i=0; i<LEN;++i)  {  /‘assign  label*/ 
W->NAME [ i J =NAME [ i 1 ; 

) 

return  W; 

)  /*  end  add_world  */ 


/ 
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find_ph  will  find  and  display  a  polyhedron  based  on  its  class 
name.  Conponent  polygons  and  instances  will  be  listed  to  the  screen. 
If  the  pointer  to  a  polyhedron  is  needed:  change  this  function 
return  PH. 


/ 


void  find_ph (LABEL, W) 

char  LABEL (MAX_LEN] ;  /‘class  label  to  look  for*/ 

WORLD  *W;  /‘world  to  search*/ 

{ 

POLYHEDRON  ‘NEXT_PH,  ‘PH; 
int  FOUND=0.  i,  MATCH; 

if  (W)  { 

printf ( "\nsearching  for  label:  (■); 
for  (i=0;i<MAX_LEN;++i)  { 

printf { ‘tc*, LABEL [i] ) ; 

) 

printf ( • ) \n* ) ; 

NEXT_PH=W- >POLYHEDRON_LIST ; 
while  (NEXT_PH)  { 

MATCH=1; 

for  (i  =  0;i<MAX_LEN;-t-+i)  { 

if  (NEXT_PH->CLASS[i) !=LABEL[i] ) { 

MATCHsO;  /‘at  least  one  character  is  different*/ 

) 

} 

if  (MATCHs=l)  { 

FOUND++ ; 

PH=NEXT_PH; 

) 

NEXT_PH  =NEXT_PH - >NEXT ; 

)  /*  end  while  */ 
if  (FOUND==0) 

printf ('NnKo  polyherdon  found  under  this  label !\n’); 
else  { 

display_ph(PH) ;  /‘show  the  polygon  found*/ 
if  (F0UND>1) 

printf (‘VnWarning  non-unique  label  (last  occurance 
listed) .\n' ) ; 

)  /*  end  else  */ 

)  /*  end  if  */ 
else 

printf ( ‘XnXnCannot  find  polyhedron  since  world  is  empty  !!!\n’); 

}  /*  end  find_ph  */ 
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APPENDIX  B  -  IMAGE  UNDERSTANDING  ROUTINES 


The  following  routines  implement  the  anlaysis  of  video  images,  localization  of  objects  in 
those  images,  evaluation  of  the  objects,  and  determination  of  avoidance  parameters  based 
on  this  analysis.  The  files  included  are  the  following: 
locatetypes.h  locateio.h  locateimagesupport.h  locateobjectsupporth 

FUNCTION:  locatetypes.h 
PURPOSE:  Defines  structures  used  in  locate.c 
AUTHORS:  Kevin  Peterson  &  Mark  DeClue 
DATE:  24  Mar  93 

STRUCTURES:  CMAPIMAGE,  NPSIMAGE.  EDGE,  POINT.  POSE.  IMG.LINE, 

OBJECT.DATA 
GLOBALS:  none 
COMMENTS:  None 


fdefine  RGB  A  1  I*  RGB  A  24  bit  images  (alpha  is  Oxff  filled)  */ 

tdefine  CMAPPED  2  /*  color  mapped  images  •/ 

«define  RGBAWITHALPHA  3  I*  RGBA  32  bit  images  where  alpha  is  read/saved 
in  the  image  files.  */ 


I*  define  a  structure  type  for  color  mapped  images  •/ 

struct  cmapimage 

\ 


short  *bitspu~,  /*  the  bits  for  the  short  images  *! 

long  nentries;  [*  the  total  number  of  entries  in  the  cdor  map  */ 

short  *reds;  /*  ptr  to  the  red  entries  of  the  color  map  *! 

short  •greens;  T  ptr  to  the  green  entries  in  the  color  map  •/ 

short  •blues;  [*  ptr  to  the  blue  entries  in  the  color  m^  •/ 

long  cmapoff^set;  /•  color  map  offset.  i.e.  the  first  color 
we  will  us  in  the  color  map  •/ 

I: 

typedef  struct  cm^image  CMAPIMAGE;  r  define  a  CMAPIMAGE  type  •/ 
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r  ddine  a  union  so  that  the  top  level  image  structure's 
last  pointer  can  point  to  sev^  differem  kinds  of  images.  */ 

union  imagedptr 

I 

long  *liitqitr,  /*  long  images  need  no  more  dasa  than  a  ptr 
to  the  bits.  */ 

CMAPIMAGE  *cmapptr.  T  acokv  mailed  image  must  have 
the  bits  and  a  color  map  so  we 
need  a  complete  structure.  */ 

}; 


I*  define  the  lop  level  structure  for  the  image  */ 

struct  image 

I 

long  type;  /•  image  type  •/ 

long  xsize;  xsize  of  the  image  */ 

long  ysize;  /*  ysize  of  the  image  */ 

char  *name;  /*  ptr  to  string  naming  the  image  */ 

union  imagedptr  imgdata:  /*  ptrs  to  data  for  this  type  of  image  V 

»; 

typedef  struct  image  NPSIMAGE;  /*  define  an  NPSIMAGE  type  */ 


typedef  struct  edge_region_iype 

\ 

char  name;  /*  fw  use  with  "view.text"  •/ 

int  active;  I*  boolean  if  past  region  is  appended  to 

a  present  region  *! 

long  first_pixel;  /*  first  and  last  pixels  added  to  region  */ 
long  last_pixel; 

long  xmin;  /*  min  &  max  pixels  for  previous  row  *! 
kmgxmax; 


long  pres.xmin,  pres_xmax,  prev_xmin,  prev_xmax;  /*  for  alii x  */ 
double  min_phi,  max_phi; 
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int  pri_i>hi_area:  r  for  use  with  constant  segmented  angles  */ 
float  sec_phi_area: 
double  temp_phi; 


double  avg  phi:  T  for  use  with  dynamic  averaging  phi  */ 
double  sum_phi; 

r  Least  Squares  Fit  momments:  */ 
long  mOO;  Number  of  pixels  */ 

double  mIO;  I*  Sum  x  */ 

double  mOl;  /*  Sum  y  */ 

double  mil;  /*  Sum  x*y  */ 

double  m20;  /*  Sum  x*x  */ 

double  m02;  T  Sum  y*y  */ 

struct  edge_region_type  *next;  /*  ptr  to  the  next  EDGE  */ 

I  EDGE; 


struct  pointjype 

I 

double  x,y;  I*  x,y  cowdinates  of  the  pixel  endpoints  *! 

I; 

typedef  struct  point.type  POINT; 


struct  pose.type 

float  x,y4hm; 

I: 

typedef  struct  pose.type  POSE; 


typedef  strua  line.type 
charname[3];  /*  for  troubleshooting*/ 
POINTpl,p2;  /*  the  2  endpoints  for  the  line  */ 
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/*  Least  Squares  Fit  monunenis:  */ 
long  mOO;  /*  Number  of  pixels  */ 

douUe  mlO;  Sum  x  */ 

double  mOl;  /*Sumy*/ 

double  ml  1;  t*  Sum  x*y  •/ 

double  m20;  /*  Sum  x*x  */ 

double  m02:  !*  Sum  y*y  */ 

double  phi;  !*  Calculated  nonnal  orientation  of  IMG.LINE  */ 

double  dmajor,  /*  Length  of  major  axis  of  equivallent  ellipse  */ 

double  dminor,  /*  Length  of  minor  axis  of  equivallent  ellipse  */ 

double  rho;  /*  Ratio  dminor/dmajor  */ 

int  orient,  /*  Line  orientation:  l«veit,  2*ihoiz.  Ssdiag  *! 
obstacle;  /*  True  if  any  part  of  line  <230  pixels  since  may 
be  obstacle  to  robot  V 

struct  linejype  *next;  T  ptr  to  the  next  IMG.UNE  in  the  image  */ 
)  IMG_LINE; 

I*  Structure  which  holds  the  infonnation  about  an  object  V 
typedef  struct  object_data 
I 

double  range,  left,  right,  top,  bottom,  width,  height; 

I  OBJECT.DATA; 
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/• - 

FILENAME:  locateio.h 

PURPOSE:  Provides  rouiiiies  for  screen  and  file  io  necessary  in  the 
locale  program. 

AUTHOR:  Mark  DeClue 
DATE:  24  Mar  93 


FILES:  writejines,  draw_lines,  di^lay_all.  display_all_loop. 
diinensionoul 
GLOBALS:  none 
CX)MMENTS:  none 

- ./ 


FUNCTION:  write_lines(x.y4mgname.funcname4ilesname) 
PURPOSE:  Writes  a  list  of  lines  with  various  parameters  to  text  file. 

PARAMETERS:  x  -  horizontal  dimension  of  image 
y  •  vertical  dimension  of  image 

imgname  •  name  of  image  from  which  lines  were  generated 
funcname  •  name  of  function  which  generated  the  lines 
filesname  •  name  of  file  to  which  lines  are  to  be  written 
RETURNS:  none 
C^LLLED  BY:  locate.c 
CALLS:  fopen.  fclose 
COMMENTS:  none 


writejines(x.y.imgname/uncname,rilesname) 
long  x,y; 
char  imgnameU; 
char  *funcname; 
char  *niesname; 

I 

IMG.LINE  *1 B  Line.list.head; 

FILE  *lines_file; 

Iines_file  >  fopen(filesname.''w''); 

f|printf(lines_rile."Lines  for  image:  jmgname); 

i^nif(lines_rile,"  Generated  by:  /uncname); 

^ntf(lines_file.”NnImage  size:  nr  pixels  x  axis  ■  %d.  nr  pixels  y  axis  ■  %d\n"4i,y) 

fi>rinif(iines_file."Extracied  line  segments  listed  in  order  by  length.NnNn”): 

whUe(l!-NULL) 

{ 
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^jrintf{lines_file."*s>  length  ■  %.4f,  orient  ■  %<!,  orientation  ■  %.4f.  mOO  » 
l>>name,  l-ximajor.  I-xirieni,  i•>phi.  l->in00); 

f^ntf(lines_fUe,”endpoints:  (%2(  %2[)  (%J2f 
l*:^!  .x,l>>p  1  .y  J->p2  Jt  J->p2.y); 

I  ■  l->next; 

I 

fclose(Unes_fUe); 

)  /*  End  write_Iines  •/ 


/• - 

FUNCTION:  draw_iines(lxokH') 

PURPOSE:  Dra  ws  extracted  lines  pointed  to  by  I  over  the  current  image 
in  an  DUS  window. 

PARAMETERS:  I  -  pointer  to  list  of  lines  to  be  displayed 
color  -  desired  color  of  lines 
RETURNS:  none 
CALLED  BY:  display_all_loop 

CALLS:  c3f,  cmov2.  move2.  draw2,  swapbuffers  (all  DUS  routines) 
COMMENTS:  none 

- */ 

draw_Unes(l.color) 

IMG_LINE  *1; 
int  color. 

I 

static  float  whitelS]  *  { 1.0,1.0,1.01;  /•  rgb  white  •/ 
static  float  black[3]  ®  (0.0,0.0,0.01;  f*  rgb  black  •/ 
int  howto; 

if(cok>r  n  Black) 
c3f(black); 
else  c3f(white); 

whi]e(l!«NULL) 

{ 

rcinov20->pl-x.l->pl  y);  charstr(l->name);  */ 
r  NOTE:  With  comments  removed,  the  above  statements  would  generate 
line  numbers  with  die  line  segments  */ 

move2(l->pl  .x4->pl  .y);  draw2(l->p2.x,l->p2.y); 

1 « l->next; 

) 

sw^pbuffersO: 

I  /*  End  draw_lines  */ 
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FUNCTION:  dispUy_aIl(imgl4nig2img3) 

PURPOSE:  IK^lays  the  gradient  image  with  or  without  lines,  lines 
alone,  grayscale  image  or  grayscale  object  only. 

PARAMETERS:  imgl  -  pir  to  grayscale  image 
img2  -  ptr  to  gradient  image 
img3  -  per  to  gradient  object  only  image 
RETURNS:  none 
CALLED  BY:  locatex 

CALLS:  prefsize(x,y).  winopen(*name').  RGBmodeO,  singldaifferO 
gconfigO.  qdevice(device  name).  di^iay_allJoop(il  jdl. 
i2  jd243).  free(m),  windoseCname"). 

COMMENTS:  none 

- */ 


display_all(img  1  .img2,img3) 

NKIMAGE  *imgl,  /*  Grayscale  image  */ 

*img2,  I*  Gradient  image  */ 

*img3;  /*  Gradient  object  only  image  */ 

I 

long  winidl.  winid2: 

prefsize(img  1  ->xsize,img  1  ->ysize); 
winidl  swinopenC’grayscale  view*); 

RGBmodeO: 

singlebufferO; 

gconfigO; 

prefsize(img2>>xsize.img2*>ysize); 
winid2>winopen(''gradient  view*); 

RGBmodeO; 

singlebufferO; 

gconfigO; 

qdfc  V  ice(REDRAW): 

qdevice(LEFTMOUSE); 

qdevice(MIDDLEMOUSE); 

qdevice(RlGHTMOUSE); 

qdevice(ESCKEY); 

printf("NnThe  following  options  are  available . .  .\n”); 
printff'Ni  Left  mouse  •>  Di^lay  grayscale  with  remaining  linesNn"); 
printf(”Vn  Miihlle  mouse  •>  Display  remaining  lines  on  whiieNn”); 
printf(”\n  Right  mouse  •>  Display  gradient  view  of  only  objec^n"); 
printf(”\nRedraw  Grayscale  ->  Display  only  grayscale  imageNn*); 
prntf("Nn  Redraw  Gr^ent  •>  Display  entire  gr^entXn”); 
printfCNi  ESC  key  ->  Quit  programNn”); 

display_aIl_loop(imgl  .winidl  ,img2,winid24mg3); 
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free(iing  1  •>iingdaia.lMi^); 

6ee(imgl); 

winclose(winidl); 

6ee(iing2->imgdaia.biisptr); 

free(img2); 

wificlose(winid2); 

free(iing3->iingdaia.bit^): 

freeCimgS); 

I  /*  End  display.all  */ 


FUNCTION:  display_all_loop(img  I  .winid  1  jfng2.winid2.iing3) 
PURPOSE:  Allows  user  lo  alternate  between  various  displays  for  the 
2  windows  idl  &  id2. 

PARAMETERS:  imgl  -  ptr  to  grayscale  image 
winidl  •  name  for  wiiKlow  #1 
img2  •  ptr  to  gradient  image 
winid2  •  name  for  window  #2 
img3  -  ptr  to  object  only  gradient  image 
RETURNS:  none 
CALLED  BY:  display.all 

CALLS:  winset(name).  Iiectwrite(qj’ji,y.p).  qread(&v), 

leshapeviewportO.  draw_white_lines(p).  c3f(color). 
clearO.  draw_biack_lines(p) 

COMMENTS:  none 

- */ 


dispiay_all_loop(img  I  .winid  I  .img2.winid24mg3) 

NreiMAGE  ‘irngl.  *img2,  •img3: 
long  winidl,  winid2; 

{ 

static  float  white[3]>(  l.O.I.O.I.O); 
short  value; 

IMG_LINE  *1; 

I B  Line_list_head; 
winset(winidl); 

lrectwrite(O.O.img  I  ->xsize- 1  .img  I  •>ysize- 1  omg  1  •>imgdata.bilsptr); 
winset(wiiud2); 

Iiectwrite(0.0,img3->xsize-l,img2->ysize-l4mg2->imgdata.bit^); 

while(TRUE) 

I 

switch(qread(&value)) 

{ 

case  REDRAW: 
winset((long)value); 
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lesiu^xviewportO; 

if(va]ue  a  winidl)  bectwrite(O.Ojingl->xsize-l,ifn£l->ysize-l.iingl->ungdata.bitsptr); 
if(value  ■■  winid2)  liBCtwrite(0.04ing2->xsize-l.iing2->ysize-l.iing2->iingdata.bitsptr); 
break; 

caseLEFTMOUSE: 
if(  value  »  0) 
i 

winsei<wiiudl): 

liectwrite(0.0  jmg  1  ->xsize- 1  jmg  1  ->ysize- 1  img  1  ->imgdaia.bitspir); 
draw  iines(l.White); 

I 

break; 

case  MIDDLEMOUSE: 
if(val  je  SB  0) 

{ 

winseU  winidl); 

c3f(white); 

clear(); 

drawjines(131ack); 

I 

break: 

case  RIGHTMOUSE: 
if(value  ==  0) 
i 

win5et(winid2); 

lrectwrite(0,04mg3->xsize- 1 4nig3->ysi2e- 1 4mg3->iingdai"  bitsptr); 

} 

break; 

caseESCKEY: 
if(  value  »=  0)  return; 
break; 
default: 
break; 

)  f*  End  switch  •/ 

}  /*  End  while  */ 

1  /*  End  display_allJoop  •/ 


FUNCTION:  dimensionout(object) 

PURPOSE:  Print  out  results  of  object  analysis. 
PARAMETERS:  object  •  Structu’e  which  contains  all  info  on  object 
RETURNS:  none 
CALLED  BY:  Iocaie.c 
CALLS:  none 
COMMENTS:  none 

- */ 
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void  dimensionouKobject) 
OBJECT_DATA  object: 
I 


prinifCV^iRange  to  object  is  cmVi’ .object  jange): 
printf('N)'«iObject  is  %.2f  cm  by  %.2f  cm\n*;(^jecLheight.  objecLwidth); 


FILENAME:  locaieiinagesupport.h 

PURPOSE:  Provides  various  routines  in  support  of  object  recognition 
programs. 

AUTHOR:  MarkDeClue 
DATE:  20  Aug  93 

FILES:  setup.model,  process.all.image,  eliminate_matching_lines, 
delete.imgline.  filter.modeLlines.  combine_horzmodel_lines. 
endpt.test 

GLOBALS:  hmodlist,  vmodlist 
COMMENTS:  none 


Wdefine  White  1 
Wdefine  Black  2 

LINE  *hmodlistKNULL,  f*  Globals  for  model  iineiist  and  model  vert  linelist  */ 
•vmodlist*NULL; 


FUNCTION:  setup.modeK) 

PURPOSE:  Gets  desired  position,  sets  up  Sth  deck  database,  &  returns 
model  view  for  this  position. 

PARAMETERS:  none 

RETURNS:  pointer  of  type  LINE.HEAD  to  the  model  line  list 
CALLED  BY:  locaie.c 

CALLS:  make.worldO.  get_view(x,yAt,worldiI) 

COMMENTS:  none 

- */ 


LINE_HEAD  *setup_modelO 
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1 

LINE_HEAD*m; 

WORLD  •fifthnoor. 

double  X,  Y,  Z,  THETA.  foca)_lengthsl.4; 
foiegroundO; 

/*  — Inioal  pose  &  max  pixel  difference  acceptance—  */ 
printf('*VnEnter  stopped  robot  position . .  .\n*); 
printf(“\nX: "); 
scanf('\»%ir.&X); 
printfCNfiY: "); 
scanfC\i%r.&Y); 
printf(”VnZ: "); 
scanf(”Vn%ir  .&Z); 
printf(“NnTHETA: "); 
scanf("\n%ir.&THETA); 
fflush(stdout); 


r  —Set  up  5th  deck  database  model  and  get  current  view—  */ 
fifthfloor  s  make_worId(); 

printfC'Nn World  has  been  generated.  Now  obtaining  model  view . . 
m=get_view(X.  Y  2.THET  A/ifthflowibcal  Jength); 
printfCView  obtainedvnVi "); 

return  (m); 

I  /*  —End  setup_model— */ 


fWCnON:  process_alI_image(ptrl.ptr2,ptr3,ptr4) 

PURPOSE:  Creates  grayscale  &  gradient  images  and  does  line  finding 
PARAMETERS;  ptrl  -  ptr  to  input  rgb  image 
ptr2  >  ptr  to  grayscale  image 
ptr3 '  ptr  to  gradient  image 
ptr4  •  ptr  to  object  only  gradient  image 
RETURNS:  none 
CALLED  BY:  locate.c 

CALLS:  rgbalong_to_bwlong(pl.&p2),  pixel_membership(z,v), 
set_pixel_black(&p),  set_pixel_white(&p), 
check_active_edgesO,  line_test(r) 

COMMENTS:  Pixel  inclusion  based  on  a  threshold  value  of  5000000  for 
gradient  magnitude. 

Least  Squares  Fit  method  for  line-finding  from  "Sonar 
Data  Inteipreuuon  for  Autonomous  Mobile  Robots'  by 
Y.Kanayama,TJ4oguchi,  &  B.Hartman,  1990. 
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Function  rgbaiong_io_bwlong  courtesy  of  M  Zyda. 

- ./ 

void  process_aU_iinage(ptrl4)tr2.pir34)tt4) 
long  •ptrl.  *pa3,  *pir4: 

{ 

EDGE  *feg: 

double  dx.  dy.  Th  «  5000000.0*3000000.0: 
register  int  i  •  0.  z  >  0; 

/*  — Calculate  bw  values  for  first  2  rows  of  input  image—  */ 
fof<t«0;  i<(2*XdimK2;  ++i) 
i 

rgba]ong_to  bwlong(ptrl(i].&ptr2[i]); 

I 


for(i  ■  Xdim  +  1;  i  <  (Xdim*(Ydim-l))-l;  ++i) 

\ 

r  Convert  color(imgl)  to  b/w(img2)  for  pixel  on  next  row  up  and  one 
pixel  over  to  the  right  so  that  all  eight  neighbm  of  pixel  i 
have  black  &  white  light  intensities.  */ 
rgba]ong_to_bwlong(ptrl{H-Xdim-fl].&ptr2(H-Xdim-fl]); 

/*  Ensure  pixel  i  is  not  in  leftmost  or  rightmost  column  */ 
if((i%Xdim  !«  0)  &&  (i%Xdim  !«  Xdim-1)) 

I 

r  Calculate  dx,dy  via  Sobel  operator  for  pixel  i.  */ 

dx  » (•ptr2[HXdim-I]  +  ptr2[i-fXdim-f  1] 

.(2*ptr2[i.l])+(2*ptr2li+l)) 

•ptr2[i-Xdim-l]  +  ptr2[i-Xdim-t-l]): 

dy  B  ( ptrZIi-fXdim-l]  (2*ptr2(H-Xdim])  ptr2[i-fXdim+l] 

•ptr2[i-Xdim-l]  -  (2*ptr2(i-Xdim])  -  pD2[i-Xdim-fl]); 

if((dx*dx)+(dy*dy)  >  Th) 

1 

pixei_membership(z.atan2(dy,dx)); 

set_inxel.black(&ptr3[z]); 

set_pixel_black(&ptr4[z]); 

1 

dse 

I 

set_pixel_white(&ptr3(z]); 

set_pixel_white(&ptr4(z]); 

) 

•f+z;  /*  Increment  the  pixel  counter  z  for  the  gradient  image.  */ 

) 
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r  If  pixel  i  is  in  the  leftmost  column,  do  dieck_active_edgesO-  */ 
else  if(i%Xdim  ■■  0) 
i 

check.active.edgesO: 

I 


J  /*  endfor  i  •/ 

/*  •-Check  remaining  EDGEs  for  lines—  */ 
reg  *  Past_edge_list_head: 
while(reg !«  NULL) 

{ 

line_test(reg); 
reg  »  reg->next; 

I 

I  /*  End  process_all_image  */ 


FUNCTION:  filter.modcIJinesO 

PURPOSE:  Removes  model  lines  which  are  <2  pixels  in  length  or  lie 
entirely  above  y  coord  of  486 
PARAMETERS:  none 

RETURNS:  y  height  of  edge  between  floor  and  wall 
CALLED  BY:  locaiex 
CALLS:  fireeCm) 

COMMENTS;  none 

- •/ 


double  filter  model  lines() 

i 

LINE  *mdh,  *mdv,  *modtemp; 
double  flooredges250.0,  yavg; 

FILE  *hmodlinefile,  *vmodlineflle; 

mdh  s  hmodlist;  /*  List  of  non-vertical  model  lines  */ 
mdv  «  vmodlist;  /*  List  of  vertical  nKxlel  lines  */ 

hmodlinefile*fopen("hmodcl_lines.text","w"); 

vmodlincfile*fqpen("vmodel_lines.text","w"); 

while(mdh !«  NULL) 

{ 

r  First  see  if  this  edge  is  the  lowest  horz  in  the  model  */ 
yavg  »  (nHlh->yi  +  mdh->Y2)/2.0; 

if((mdh->X2  >  200.0)  &&  (mdh->Xl  <  400.0)  &&  (yavg  <  flooredge)) 
flooredge  «  yavg; 
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r  Test  non-venicals  for  length  <  2  or  location  above  486  */ 

if((fabs(in<8i->X2  •  nulh->XI)  <  2.0)  II  ((mdh->YI  >  486)  At  (indh->Y2  >  486))) 

I 

/*  If  lemoval  criteria  met.  delete  from  the  linked  list  */ 
if(hmodiist  ■«  mdh) 

I 

hmodlist  ■  mdh->NEXT; 

free(mdh); 

mdh  ■  hmodlist; 

» 

else 

{ 

modtemp->NEXT  ■  mdh->NEXT: 
free(mdh); 

mdh  ■  modtemp->NEXT; 

I 

I 

else 

I 

lprintf(hmodlinefile."yl:  %2{  y2:  %.2f  xl;  %.2f  x2:  %.2fvi*. 

mdh->  Y I  ,mdh->  Y2  jndh->X  I  jndh->X2); 
modiemp  «  mdh; 
mdh  s  mdh->NEXT; 

» 

I 


while(mdv  !■  NULL) 

{ 

I*  Test  verticals  for  length  <  2  or  location  above  486  */ 

if((fabs(mdv->Y2  -  mdv.>YI)  <  2.0)  II  ((mdv->Yl  >  486)  At  (mdv->Y2  >  486))) 

r  If  removal  criteria  met,  delete  from  the  linked  list  */ 
if(vmodlist  n  mdv) 

I 

vmodlist «  mdv->NEXT; 

free(mdv); 

mdv  ■  vmodlist; 

I 

else 

I 

modtemp->NEXT  ■  mdv->NEXT; 
free(mdv); 

mdv  a  modtemp>>NEXT; 

» 

) 

else 
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I 

fprinlf(vniodIinefi]e.*yl:  %2f  y2:  %2f  xl:  *.2f  x2: 
mdv->Y  1  ,mdv->Y2  jndv->X  1 4nclv->X2): 

modtemp  «  rndv. 
mdv  *  indv->NEXT; 

I 

I 

fcloseOimodlinefile); 

fciose(vinod]inefile); 

retunKflooredge); 

}  /*  End  fillcr_modcl_lines  •/ 


FUNCTION:  Combine_hoizinodel_lines() 

PURPOSE:  Combines  model  line  segments  into  contiguous  lines 
PARAMETERS:  none 
RETURNS:  none 
CALLED  BY:  locates 
CALLS:  none 

COMMENTS:  updates  the  list  pointed  to  by  the  global  hmodlist 


void  combine.hoRmodel.IinesO 

I 

LINE  •temp,  •mdhl,  •mdh2; 

double  ylimit=1.0,  xlimits  -2.0;  /•pixel  dist  to  which  line  segments  are 
considered  close  enough  to  combine  •/ 

mdhl  s  temp s  hmodlist; 

while<mdhl  IsNULL) 

{ 

mdh2  s  mdhI->NEXT; 

while(mdh2  Is  NULL) 

I 

if((fabs(mdhl->YI  -  mdh2->Yl)  <  ylimit)  &&  /•  lines  are  same  height  •/ 
((mdh2->Xl  -  mdhl->X2)  >  xlimit)  && 

(m(ni2->X2<mdhl->X2)) 

{ 

mdhl->X2-mdh2->X2; 
temp->NEXT  »  mdh2->NEXT; 

&ee(mdh2); 

mdh2  ■  tcmp->NEXT; 

) 
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else  if((firi)s(nKlil->Yl  -  iiidh2->Yl)  <  ylimit)  AA  lines  are  same  heiglu  */ 
((indhl->Xl  •  nidh2->X2)  >  xlimit)  AA 
(nidh2->Xl  >  mdhl->Xl)) 

I 

nKlhl->Xl «  nidti2->Xl; 

temp->NEXT  «  mdh2->NEXT; 

free(nidh2); 

mdh2  >  iemp->NEXT: 

) 

else 

I 

lempBindli2; 
mdh2  >  mdh2->NEXT; 

I 

I  rend  inner  while  */ 

mdhl  >  indhl->NEXT; 
iemp«  mdhl; 

I  rend  outer  while  */ 

)  r  end  combine.harzmodeijines  */ 


r - 

FUNCTION:  elimina(e_malching_Iines(pixdiff.nooredge) 

PURPOSE:  Removes  image  lines  which  match  to  model  lines 
PARAMETERS:  pixdiff  -  user  chosen  value  for  max  allowable  dist  between 
an  image  and  model  line  (in  pixels)  in  order  to  have  a  match, 
flooredge  •  y  coord  of  wall  to  floor  edge  based  on  model. 
RETURNS:  none 
CALLED  BY:  locate.c 
CALLS:  aian2(x,y).  free(m) 

COMMENTS:  any  img  lines  within  20  pixels  of  the  left  or  right  edge 
of  the  image  or  2  pixels  from  bottom  are  also  deleted. 
- */ 


void  eiiminate_maiching_lines(pixdifr,f1ooredge) 
double  pixdiff,floofedge: 

{ 


IMG_LINE  *imgtemp.  •im,  *delete_imglineO: 

LINE  *md,  *mdv; 

double  hoiz.mid.  r  avg  y  coord  for  a  horizontal  image  line  */ 
diag«0.0; 

int  remlineaO,  tmpcntsO, 
r  flags*/ 
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lemvaK),  /*  set  to  1  if  line  wAn  20  pixels  of  left  or  right  */ 
hoczaO,  vertaO./*settol  if  line  fits  hoiz/ven  oiieha  */ 
endpt-testO: 

imgtemp  ■  Line_list_liead;  /*  List  of  image  lines  */ 
im  s  Line_list_head; 

printfCNiNnflooredge  is  %.2f\n”41oore<^e); 

while(im  !>  NULL) 

{ 


if((im->pi.y  >  flooredge)  &&,  (im->p2.y  >  flooredge)) 

i 

im  s  deiete_imgline(im4mgtemp); 
iemline+4-; 

I 

else 

I 


md  «  hmodlisu  /*  List  of  non-vertical  model  lines  */ 
mdv  *  vmodlist;  /*  List  of  vertical  model  lines  */ 

/*  —Sort  out  if  img  line  is  vert,  hoiz,  or  diagonal  and  test  for  elimination 
based  on  closeness  to  edge  of  picture  frame —  V 

if(fabs(im->phi)  <  0.0698)/*  Looking  for  vert  lines  (w4n  4  deg  of  vert)  •/ 

I 

if((im->pl.x  <  20)  II  (im->pl.x  >  626))  lemvsl; 

vert»l; 

im->orient«l: 

if((im->pl.y  <  250.0)  II  (im->p2.y  <  250.0)) 
im->ol»taclesl; 

else  im->obstaclea0;  /*  Any  lines  above  250  pixels  can't  effect  robot  */ 

I 

else  if((  1.5708  -  fabs(im->phi))  <  0.061)  /•  Looking  few  hoiz  lines  */ 

I 

horz_mid=(im->pl.y  +  im->p2.y)/2.0;  (*  Calc  avg  y  cotwd  for  image  line  *! 

im->orients2; 

horz«l; 

if(hoi2_mid  <  250.0) 
im->obstaclesl; 

else  im->obstacle*0;  /*  Any  lines  above  250  pixels  can’t  effect  robot  */ 

I 

else 

1 

diag  «  atan2((im->p2.x  -  im->pl.x).(im->p2.y  -  im->pl.y)); 
im->orientB3: 

iKWZsl; 
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if((iin->pl.y  <  2S0.0)  U  (iin->p2.y  <  2S0.0)) 
im-xAstacleal; 

else  iin>>obstacle^.  I*  Any  lines  above  250  pixels  can't  effect  robot  */ 

1 


/*  —Now  that  pKliminary  analysis  is  done  on  the  tine,  compare  to  model, 
delete  as  required,  and  update  pointers/couniers —  */ 

while((mdv  !«  NULL)  &&  (vert)) 

{ 

r  Remove  vert  img  line  if  within  pixdiff  of  a  vert  model  line  or  if 
if  it  was  set  for  removal  because  it  was  within  20  pixels  of  an  edge  */ 

if(((fabs(im->pl.x  -  mdv->Xl)  <  pixdifO  &&  endpt_iest(mdv  jm4>ixdif0)  H  remv) 

I 

remvsO; 
vert=0; 
remline  ++; 

im  ■  delete  imgline(im,imgtemp); 

I 

else  mdv  =  mdv->NEXT; 

1  /*  —End  2nd  whUe— •/ 
while((md  !«  NULL)  &.&.  (hoiz)) 

f*  Remove  img  line  if  within  inxdiff  of  a  model  line,  it  lies  within  2 
pixels  of  bonom.  or  it’s  diagonal  and  is  oriented  within  5  degrees  of 
a  model  diagonal  line  *! 

if(((fabs(hoR_mid  •  md->Yl)  <  pixdifQ  &&  endpl_test(md,im4>ixdiff))  II 
(horz_mid  <  2)  II 

(fabs(atan2((md->X2  •  md->Xl).(md->Y2  •  md->Yl))  -  fabs(diag))  <  0.0873)) 

I 

hors=0; 
remline  ++: 

ims  delete  imgline(im,imgtemp); 

I 

else  md  «  md->NEXT; 

I  /*  — End  3rd  while—  */ 

if(remline  » tmpcnt)  I*  line  was  not  removed,  so  update  pointers  */ 

imgtemp  « im; 
im  >  im->next; 

} 

else  tmpcnt34«mline; 
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vertPO; 

hon:^. 

diag>0.0; 

I 

I  /•  “End  1st  while—  */ 

Linecount  >  Linecount-remline:  I*  Update  Linecount  to  teflect  loss  of  lines  */ 
piintf(”VnNumber  lines  remaining  «  %<Ni”  J.inecount): 

I  r  End  eliminaie_inalching_lines  */ 


I* - 

FUNCTION:  delete_imgline 
PURPOSE:  Deletes  an  image  line  from  the  linked  list 
PARAMETERS:  im  •  pointer  to  the  location  being  removed  from  the 
linked  list 

imtemp  -  pointer  to  list  location  immediately  before  that 
to  which  im  points 

RETURNS:  pointer  to  the  new  current  location 
CALLED  BY:  eliminate_matching_lines 
CALLS:  none 
COMMENTS:  none 


IMG.LINE  *delete_img[ine(im,imgtemp) 
IMG_LINE  ‘im.^irngtemp; 

I 


if(Line  list  head  im) 

{ 

Line_list_head  « im->next; 
free(im); 

imsLine  list  head; 

} 

else 

{ 

imgtemp->next « im->next; 
fiee(im); 

im  s  imgtemp->next; 

I 

retuni(im); 

}  I*  end  delete.imgline  */ 
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FUNCTION:  endpt_lest(m(ljin.della) 

PURPOSE:  dmnnine  if  the  image  line  is  within  delta  of  the  confines 
of  the  model  line 

PARAMETERS:  md  •  pir  to  a  model  line 
im  •  ptr  to  an  image  line 
delta  •  max  pixel  difference  for  endpt  inclusion 
RETURNS:  1  if  within  endpt  limit /O  if  outside  of  limit 
CALLED  BY:  eliniinate_matching_lines 
CALLS:  none 
COMMENTS:  none 

_ _ _ _ — ■  - -  *  / 


im  endpt_test(md  jm.delta) 

LlNE^md; 

IMG.UNE  ‘im: 
double  della: 

I 

double  mdelta: 

mdelta«  -delta; 
swiich(im->orient) 

{ 

case  1; 

/•printf("Vn\n%.2f  %2{  and  %.2{  %.2fn".md->Y2.im->p2.yjnd->yi4m->pl.y):*/ 
tf((im->pl.y  >  md->YI)  &.&.  (im->p2.y  <  md->Y2)) 
retum(l); 
else  retum(O); 
break; 
case  2: 

if(im->pl.x  >  im->p2.x) 

i 

if((im->p2.x  >  md->X2)  &&  (im->pl.x  <  md->Xl)) 
letum(I); 
else  letum(O): 

) 

else 

{ 

if((im->pl.x  >  md->X2)  &&  (im->p2.x  <  md->Xl)) 
retum(l); 
else  fetum(O); 

) 

break; 
case  3: 
default 
retum(O); 
break; 

) 

I  /*  end  endpt.test  */ 
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FILENAME:  locaieobjectsuppofth 

PURPOSE:  Provides  various  routines  in  siqipoft  of  object  recognition. 
AUTHOR;  MartDeClue 
DATE:  20  Aug  93 

FILES:  isolate.object,  iso.objeci,  exchange,  hpartition.  vpartition, 
Hson,  Vsort,  get_range.  endpt.test,  get_difnensions. 
avoid.object,  fillairay 
GLOBALS:  none 
COMMENTS:  none 


•/ 


IMG_LINE  harTay[100].  varray[100]; 
int  vcntsO,  hcntsO; 


/• - 

FUNCTION:  fiUarrayO 

PURPOSE:  Fills  varray  &  harray  with  lines  from  Line  list. 
PARAMETERS:  none 
RETURNS:  none 
CALLED  BY:  locate.c 
CALLS:  none 

COMMENTS:  Note  that  element  zero  does  not  get  data 
- V 


mianayO 

( 

IMG.LINE  *1  =  Line_Ust_head; 
intksl; 


vaiTay[vcnt].pl.x  =  0.0; 
varraylvcnt].p2.x  =  0.0; 
varraylvcntj.pl.y  =  0.0; 
vaiTay[vcnt],p2.y  =  0.0; 
haiTay(hcnt].pl.x  =  0.0; 
harray[hcnt].p2.x  »  0.0; 
harray[hcnt].pl.y  s  0.0; 
harray[hcnl].p2.y  s  0.0; 


while(l!»NULL) 

i 

if(l->orient « 1) 

1 

vcnt++; 
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vanay(vcntl.pl.x  « l->pl.x; 
varray[vcnt].p2.x  » l->p2.x: 
vanay  [vcml.pl  .y  ■  l->pl.y; 
vaiTay[vcnt).p2.y  « l->p2.y; 
vaiTay[vcnt].obj^le  ■  l->obstacle: 
I 

else  if(l->oriem  ■■  2) 

{ 

hcnt-M-; 

hanay  [hcntl.pl. X  ■  l->pl.x; 
hanay[hcnt].p2.x  « l->p2.x: 
harray[hcnt].pl.y  •  l•>pl.y: 
harray[hcnl].p2.y  <->p2.y; 
harray[hcntl.obsiacle  ■  l•>obslacle: 

» 


I  ■  l->next: 

I 

Hson(  1  .hcnuhanay); 

Vson(  1  .vcnuvarray): 

r 

while(k  <s  hcnt) 

[ 

printf(“\n  y  «  ^.2fVn".harniy[k].pl.y); 
k++; 

I 

k=l; 

while(k  <B  vent) 

[ 

printf("\ii  X  »  %.2fSn".v;.'Tayfk].pl.x); 

k-H-; 

I 

•/ 

prinif("\nNn  vent  =  %d  hcnt  ■  %<Ni".vcnt,hcnt); 
I  /•  End  ruianay  •/ 


/*• 


The  following  routines  are  used  for  sorting  img  lines  into 
ascending  order  to  allow  grouping  for  multi-object  analysis. 
The  implementation  is  adapted  from  algorithms  (nesented  in 
ref  [MAN891  of  the  thesis. 
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exchange(A3,V_line) 
int  AS; 

EMG.LINE  V_Une[]: 

{ 

IMG_LINE  temp; 

temp  =  V_linc[A]; 
V_line[A] »  VJine[B]; 
V  liiie[B]  s  temp; 

I 


int  hpanition(left  jight  Ji.line) 
int  left,  right; 

IMG.LINE  H_Une[]; 

{ 

double  pivot; 
int  LSJniddle; 

pivot »  H_lin^Ileft].pl.y; 

L  =  left; 

R  =  right; 
whilefL  <  R) 

I 

while((H_line[Ll.pl.y  <=  pivot)  &&  (L  <=  right)) 
UL+1; 

while({H_line[R].pl.y  >  pivot)  &&  (R  >=  left)) 
R=R-1; 
if(L<R) 

exchange(LJl,H_line); 

) 

middle  s  R; 

exchangefleftjniddleSJine); 

retum(middle); 

} 


int  vpaitition(leftjight.VJine) 
int  left,  right; 

IMG  LINE  V_Une(); 

{ 

double  pivou 
int  LSjniddle; 

pivot  ■  V_linerieft].pl.x; 

L  =  left; 

R  s  right; 
while(L  <  R) 
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{ 

while((V_liiie[L]4)l.x  <»  pivot)  &.&.  (L  <«  right)) 
UL-t-1; 

while((V_line[R].pl.x  >  pivot)  &.&  (R  >«  left)) 
R«R-1; 
if{L<R) 

exchange(LJ(.V  line): 

I 

middle  «R: 

exchange(leftjniddle,V_line); 

retum(middle); 

I 


Hsort(left/ight,H_line) 
IMG.LINE  HJineD; 
int  left,  right; 


I 

int  middle; 
int  panitionO; 

if(left  <  right) 

( 

middle  s  hpartition(leftjight,H_line); 
Hsort(left  jniddle- 1  Jl_line); 
Hson(middle-«-ljight,H  line); 

I 


I 


V  son(left  jight,  V_line) 
IMG.LINE  V.lineD: 
int  left,  right; 


i 

int  middle; 
int  paititioiiO; 

if(left  <  right) 

{ 

middle  •  vpafiition(lefuight,V_line): 
Vsort(left4niddle-l  ,V_line); 
Vs(Ht(middle-«-ljight,V  line); 

) 


» 
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FUNCTION:  iso.objcctO 

PURPOSE:  Locates  object  in  multi-object  environment 
PARAMETERS:  none 

RETURNS:  object  -  Info  on  the  position  of  the  object 
CALLED  BY:  locatex 
CALLS:  hora.checkO 
COMMENTS:  none 

- •/ 


OBJECT_DATA  iso_object(img) 
NPSIMAGE  ‘img; 


{ 

OBJECT.DATA  object; 

IMG.LINE  *1: 
long  *ptr,winid,x]en; 
register  int  z; 

char  linename[3]; 

int  i*l,  j®2,  matchsO,  bottom,  top,  horz_checkO: 


xlen  a  img->xsize; 

ptr  s  img->imgdaia.bitsptr: 

i  *  Linejist.head; 

while(i  <s  vent) 

{ 

if(!vaiTay[i].obstacle)  j  =  vcnt+I; 

while(0  <=  ''cnt)  &&  Imatch) 

I 

if(varray[j].obstacle  && 

((varrayOl.pl.x  -  vanaylil.pl.^.  >  10.0)  && 
(bottom  *  horz_check(vaiTay(i].pl.x,vairay[j].pl.x, 
IJicnt,!))) 

{ 

match  « 1; 

top  =  horz_check(varTay[i].pl.x,vanay[j].pl.x. 
(bottom),hcnt,0); 

) 

clse>H-; 

1 1*  end  inner  while  */ 
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if(!  match) 

{ 

i++; 

j»i+l; 

I 

else 

{ 

objecLieft  ■  vafTay[i].pl.x; 
objecLright  *  varTay[i].pI.x; 
objecLbottom  *  harrayCbonoml.pl.y; 
objecLiop  m  hanay[iop].pl.y; 
i  >  vent  >  1;  r  gets  out  of  outer  while  kx^  */ 

I 

)  /*  end  outer  white  */ 

printf(”\n\nLeftK  %.2f  right-  %2f  hot-  %.2f  top-  %.2Nt*.object.left. 
objectjight.objecLbottom,object.top); 

r  —These  2  steps  are  just  done  during  testing  to  'see'  how  well  the  image 
is  being  isolated  and  isn't  necessary  for  actual  obstacle  avoidance —  */ 

f*  —Set  pixels  white  except  those  in  an  area  around  the  object—  */ 

forfz-xlerH-l;  z<((object.topt20)*xlen>»-l;  z++) 

{ 

if((  (z%xlen)  <  (object.left*S))  II  ((z%xlen)  >  (object  jight+5))) 
set_pixel_white(&ptr(z]): 

1 

/•  —Set  remaining  pixels  above  object  to  white—  •/ 

for(z-((object.top+20)*xlen)+l;  z<(xlen*(img->ysize  - 1))  -  1;  z++) 

I 

set_pixeLwhite(&ptr[z]); 

} 


retunKobject); 

I  /*  end  iso_obj  •/ 


/• - 

FUNCTION:  hofz_check(lefuight,staftcnundcnt,bottom) 
PURPOSE:  Determines  if  a  hont  line  exists  between  the  two  potential 
lines  for  the  left  and  right  side. 

PARAMETERS:  left  •  potential  left  side  of  object 
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right  -  potential  right  side  of  object 
startcnt  •  element  where  the  array  is  cunetly  being  accessed 
endcnt  -  last  element  of  array  with  data 
bottom  - 1  if  looking  for  bottom  line;  0  for  top 
RETURNS:  0  if  no  line  inbetween  or  element  number  in  the  array  where 
the  inbetween  line  is  located 
CALLED  BY:  iso.obJectO 
CALLS:  none 
COMMENTS:  none 

- •/ 


int  horz_check(leftjight^tartcnt,endcnt,bottom) 
double  left,  right; 
int  startcnt,  endcnt,  bottom; 


{ 

int  issiartcnt+1,  match=0; 

if(boaom) 

{ 

while((i  <s  endcnt)  &&  imatch) 

{ 

if(harray[il.obstacle  && 
(fabs(ha(ray[i].pl.x  •  left)  o  10.0)  && 
(fabs(right  •  hamy(i].p2.x)  <»  10.0)) 
match  B  1; 
else  i++; 

I 


if(match)  return<i); 
else  return(O); 

) 

else 

I 

while((i  <s  endcnt)  &&  Imatch) 

{ 

if(harray[i].obsiacle  && 

((harray[i].pl.y  •  harray[startcnt].pl.y)  >s  10.0)  && 
(fabs(harray[i].pl.x  -  left)  o  10.0)  && 

(fabs(right  -  hamy[i].p2.x)  <s  lO.O)) 
match  =  1; 
elsei++; 

I 

if(match)  leturn(i); 
else  return(0); 

} 

)  r  end  hoR.check  •/ 
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FUNCTION:  isoiate_objeci(img.object) 

PURPOSE:  Searches  the  remaining  img  lines  (hopefully  an  object  is 
present)  and  whites  out  all  but  an  area  around  the  object 
Then  gets  data  needed  by  robot  for  obstacle  avoidance. 
PARAMETERS:  img  •  ptr  to  gradient  object  only  image 

object  •  structure  which  will  hold  range  &  dimension  info 
RETURNS:  object  -  structure  holding  range  &  dimension  info 
CALLED  BY:  locate.c 
CALLS:  set_puel_white(&p) 

COMMENTS:  Oiginal  obj  isolation  routine:  doesn't  employ  array  stnic. 
Applicable  to  single  object  case. 


OBJECT_DATA  isolaie_object(img) 
NPSIMAGE  *img; 


I 

IMG.LINE  •!.  •lefUine*NULL,  •rightUne»NULL: 
OBJECT.DATA  object; 
double  clearance,  inittop; 
long  *ptr.winid,xlen; 
register  int  z; 

int  countersO; 
char  linename[3]: 

xlen  B  img->xsize; 

ptr  *  img->imgdata.bitsptr; 

I  s  Linejist.head; 

fotegroundO: 

leftline  ■  (IMG_LINE  •)malloc(sizeof(IMG_LINE)); 
rightline  *  (1MG_LINE  *)malloc(sizeof(lMG_LINE)); 
ieftline->pl.x  «  0.0; 
leftline->pl.y  «  0.0; 

Ieftline->p2.x  >  0.0; 

Iefitline->p2.y  ■  0.0; 
rightline->pl.x  ■  0.0; 
rightline->pl.y  ■  0.0; 
rightline->p2.x  «  0.0; 
rightline->p2.y  >  0.0; 

/*  —From  remaining  lines,  find  vert/obstacle  line  furthest  to  left—  */ 
object.left  >  626.0; 
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whiled  !«NULL) 

{ 

r  orienis]  means  vertical  and  obstacle  means  y<250  */ 
if((l->orientnl)  &&  l->obstacle  &&  0*>pl-x  <  objecLleft)) 
i 

objecLleft « l->pl.x; 

leftline  » 1;  T  *nus  line  is  the  left  edge  of  the  object  */ 

i 

1  ■  l->next: 

I  rend  while*/ 


I  a  Line_list_head; 


/*  — From  remaining  lines,  find  vert/obstacle  line  second  furthest  to  left 
but  at  least  5  pixels  away  ftom  line  set  as  left  side—  */ 

object  jight »  626.0; 
whUed  !=  NULL) 

{ 

if(d->orient=sl)  &&  l->obstacle  &&  (l->pl.x  <  objectright)  && 
(l->pl.x  >  (object.left-t-5.0))) 

I 

objectright  s  l->pl.x: 

rightline  « I;  /*  This  line  is  the  right  edge  of  the  object  */ 

I 

f 

1 » l->next; 

I  /*end  while*/ 

plintf('^nLeftside  s  %.2f  Rightside  *  %.2fVn".object.left.objectxight); 

/* 

printf("Vn'nleftpl  *  %.2f ,  %.2fn".leftline->pl.xJeftline->pLy); 
printf("\n\nrightpl  =  %.2f ,  %2fNn"jightline->pl.x4ighiline->pl.y): 
printf("Sn'vileftp2  =  %.2{ ,  %.2f«",leftline->p2.xjeftline->p2.y); 
printf(”NnNnrightp2  s  %.2f ,  %.2fV)''/ightline->p2.x  jightline->p2.y); 

*/ 

/*  — Determine  top/bottom  most  point  for  the  sides  of  the  object—  */ 

if(leftline->pl.y  >=  leftline->p2.y) 

{ 

inittop  s  ieftline'>pl  .y; 
objectboaom  =  Ieftline->p2.y; 

) 

else 

{ 

ininc^  s  Ieftline->p2.y; 
objectbottom  « leftline->pLy; 

) 

if(rightline->pl.y  »  rightline->p2.y) 

I 
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if(rightltne->pl.y  >•  iiiittt)p)  inittop  ■  rightline-^l.y; 

else  if(rightline->p2.y  <s  (Ajectbottom)  (Aject.boaom  «  rightliiie->p2.y; 

) 

else 

I 

if(rightline->p2.y  >*  initlop)  ininop  « iightline->p2.y: 

else  if(rightlifie->pl.y  <•  objecLbottom)  object.boaoin  «  rightline->pl.y; 

) 

printfC>n\nininop  •  %.2f  initbotion  >  %.2f\n\n*4nittop,(4>jecLbonom); 

f*  — Search  for  the  image  lines  which  make  up  the  top  and  bottom  edges —  */ 

I «  Line_list_head; 
objecuop  «  250.0: 

whiled !«  NULL) 

( 

if((l->orient  n  2)  &&  ((fabs(objecLlelt  -  l->pLx))  <s  10.0)  && 
((fabs(objecLright  -  l->p2.x))  <»  10.0))  /*  Line  is  within  10  pixels 

of  left/right  edge  */ 

{ 

if(l->pl.y  <=  objecLbottom)  object.bottom  =  l->pl.y; 

if((l->pl.y  >  inittop)  &&.  (l->pl.y  <«  object.top))  objecttop  s  l->pl.y; 

1 

1  =  l->ncxt: 

1 


printfC^iBottom  at  %2f  Top  at  %  JfSn",object.bottom.object.top): 

/*  — These  2  steps  are  just  done  during  testing  to  'see*  how  well  the  image 
is  being  isolated  and  isn't  necessary  for  actual  obstacle  avoidance--  */ 

/*  — Set  pixels  white  excq>t  those  in  an  area  around  the  object—  */ 

for(zs;ilen-t-l;  z<((object.top+20)*xlen)+l;  z++) 

1 

if((  (z%xien)  <  (objecl.left-5))  II  ((z%xlen)  >  (objectJight+5))) 
set_pixel  white(&ptr[z]); 

) 

/*  — Set  remaining  pixels  above  object  to  white—  */ 

for(zs((objecLtop+20)*xlen>»-l;  z<(xlen*(img->ysize  - 1))  - 1;  z++) 

{ 

set_pixel  white(&ptr[z]); 

I 


ietum(object); 

)  /*  End  isolate.object  V 
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FUNCTION:  get_range 

PURPOSE:  Detennines  range  to  an  object  by  base  pixel  height 
PARAMETERS:  bottom  -  the  vert  coord  in  pixels  of  the  object's  base 
RETURNS:  range  •  the  range  to  the  object 
CALLED  BY:  locatex 
CALLS:  none 

COMMENTS:  Uses  range  equation  as  derived  in  thesis 


OBJECT_DATA  get_range(object) 
OBJECT.DATA  object; 

I 


double  alphasO.032,  hs86.36,  deltasB8.26E-4: 
double  arg,  pix: 

pix  s  (486.0/20)  -  objecLbottom; 
arg  =  alpha-»-pix*deita; 
object  jange  >  h  /  tan(arg); 

retum(object); 

)  /*  end  get.range  •/ 


FUNCTION:  get.dimensions 

PURPOSE:  Detennines  the  dimensions  of  an  object 

PARAMETERS:  range  •  the  range  to  the  object 

object  -  the  structure  which  upon  being  sent  to  this  routine 
contains  the  leftAight  sides  in  pixels  along  the 
hor2  axis  and  top/bottom  along  the  vat  axis 
RETURNS:  object  -  the  same  lefl/right,  top/bottom  values  as  sent  in 
but  also  the  calculated  width  and  height  in  cm. 

CALLED  BY:  locate.c 
CALLS:  none 

COMMENTS:  Uses  image  pixel  to  physical  length  conversion  factor  (delta) 
of  120S/d  as  described  in  thesis 

-*/ 


OBJECT_DATA  getjdimensions(object) 
OBJECT  DATA  object; 

I 

double  pixeLwidth.  pixeLheight,  delta; 
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della  « 1205.0/objecLiange; 

pixeLwidth  «  objecuight  -  objectJeft; 
pixeLbeighi  •  objecLiop  -  objecLboaom; 

objectheight «  pixel.hdght  *  (l.Q/delia); 
object-width  *  pixel.width  *  (l.(Vdelta); 

retunKobject); 

}  f*  end  get.diinensions  •/ 


FUNCTION;  avoid.objectO 

PURPOSE:  Calculates  the  shift  distance  necessary  to  avoid  the  given 
object  by  1  meter 

PARAMETERS:  leftside  -  left  edge  of  the  object  to  be  avoided 
rightside  •  right  edge  of  the  object  to  be  avoided 
RETURNS:  shift  -  the  distance  (in  cm)  necessary  to  avoid  object  where 
a  positive  value  is  a  right  shift,  a  negative  value 
is  a  left  shift,  and  0.0  is  maintain  current  path. 

CALLED  BY;  locate.c 
CALLS:  none 
COMMENTS:  none 


double  avoid_object(leftside  jightside) 
double  leftsidejightside; 

1 

double  deltaright.  deltaleft,  shiftslOOO.O,  mid(lles646.0/2.0; 

dellarightsmiddle-righlside; 

delialefisleftside-middle; 

if(deltaright  >=  0.0)  /*  obj  completely  to  left  •/ 

{ 

if(deltaright  >-  100.0)  shift »  0.0; 
else  shift  =  100.0  -  deltaright; 

) 

else  if(leftside  >*  0.0)  f*  obj  completely  to  right  •/ 

{ 

if(deltaleft  >s  100.0)  shift  s  0.0; 
else  shift  s  deltaleft  - 100.0; 

I 

else 

1 

if((fabs(deltaleft))  <  (fabs(deliaright))) 

shift  *  deltaleft  - 100.0;  /*  obj  more  to  right  so  shift  left  •/ 
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else  shift  *  100.0  -  deltaright;  /•  obj  more  to  left  so  shift  right  */ 

) 

if((shift  >  0.0)  &.&.  (shift  <  1000.0)) 

printf("NnNnln  order  to  avoid  the  object,  shift  %.  If  cm  to  right^*,shift): 
else  iftshift  <  0.0) 

printfCNnVnln  order  to  avmd  the  object,  shift  %.lf  cm  to  lefNi* .-shift); 
else  if(shift  «  0.0) 

printf('^n^nNo  path  alteration  necessary  to  avoid  objecftn*); 
if(shift  «  1000.0)  /*  None  of  the  conditions  applied  */ 

{ 

shift  >  0.0; 

printf(‘>nNnCan't  interpret  object;  maintaining  present  pathNn*); 

1 

retum(shift); 

I  /*  end  avoid_object  */ 
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APPENDIX  C  -  SUPPORT  ROUTINES 


SHOWMODEL:  This  routine  is  simple  in  nature  and  yet  proved  to  be  very  useful  during  much  of  the 
research  work.  When  called,  the  user  is  prompted  for  x,  y,  z,  and  6  coordinates  of  the  camera  based  on  the 
original  model  coordinate  system  with  distances  in  inches  (a  version  which  accepts  data  based  on  the  current 
coordinate  system  with  distances  in  centimeters  was  also  created  SHOW_MODEL_C^.  The  result  of  this 
input  is  a  window,  which  may  be  placed  anywhere  on  the  screen,  displaying  the  two-dimensional  view 
generated  from  the  wire-frame  model  for  the  input  position  placed  over  a  white  background. 


/•  FUCNTION:  SHOWMODEL.C  •/ 

/*  PURPOSE:  Presents  model  view  based  on  keyboard  input  of  */ 
I*  position  as  X,  Y,  Z  and  theta.  */ 

/•  PARAMETERS:  none  •/ 

/•RETURNS:  none  •/ 

/•CALLED  BY:  none  •/ 

/•  CALLS  TO:  make_world.  get_view,  draw_lines.  free_lines  •/ 
/•  GLOBALS:  none  •/ 


tinclude  <gl.h>  /•  SiliconGraphics  (r)  graphic  library  •/ 

iinclude  <gl/image.h>  /•  SGI  image  structure  libr^  •/ 

Itinclude  <device.h>  /  •  Machine-dependent  device  library  •/ 

/•  for  keys  and  mouse-buttons  •/ 
#include  <stdio.h>  /•  C  standard  i/o  library  •/ 

#include  <math.h>  /•  C  math  library  for  atan20  */ 

#include  “model2d+.h"  /*  Wireframe  model  graphics  code  •/ 

#include  “modelSth.h”  /•  “  •/ 

#include  “modelgraphics.h”  /•  “  •/ 

#include  "modelvisibility.h*'  /•  “  •/ 


#include  “showmod.supporth”  /*  Support  structures/routines  •/ 


Wdefine  focalength  1.4  /♦  Focal  length  •/ 

main() 


WORLD  •FifthFloor, 

LDME.HEAD  •model  =  NULL; 
long  winid; 

static  float  white[3]  =  1 1.0, 1.0, 1.0); 
VIEWPT  •getview; 


foregroundO; 

getview  =  (VIEWPT  •)  maUoc(sizeof(VIEWPT)); 


/• — Get  pose  values  for  model  image, 

Initi^ize  world  database  for  6fth  floor  of  Spanagie  Hall  &  determine 
2D  view  of  environment —  •/ 


model  s  setup.modelO; 

/•  —Set  up  display  configuration—  •/ 

prefsize(64g,  486); 
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winid  ■  winopenC'MODEL  VIEW”); 

RGBmodeO: 

singlebuffe^: 

gconfigO; 

winsetCwinid); 

I*  — Display  image  on  white  background—  */ 

c3f(whiie); 

cle^; 

draw_Unes(ml->LINE_LIST,  ml->VLINE_LlST); 

{MintfCNiEnter  1  to  quit  ->  “); 
scanf(‘^n%l^,  &getview->Z); 

/*  — Wrap  up  viewing —  •/ 

fTee_lines(ml); 
winclose(  winid); 

printfC'Sn  Thank's  for  using  showmodel  \n\n"); 
ir  ---End  showmodel—  •/ 


CHANGEOVERLAY:  The  p^ary  use  for  this  program  is  in  determining  if  an  image,  based  on  a  physical 
position  for  the  camera,  coincides  properly  with  the  view  predicted  by  the  model.  This  routine  is  called  with 
an  input  argument  of  a  sgi/rgb  stored  unage.  The  image  is  then  displayed  in  a  window,  which  may  be  placed 
anywhere  on  the  screen,  and  the  user  is  then  prompt^  for  position  input  as  in  SHOW.MODEL.  Following 
processing,  the  two-dimensionaJ  model  view  for  this  position  is  super-imposed  over  the  image.  A  menu  of 
options  is  provided  next  which  allows  any  of  the  following  to  be  carried  out: 

•  Display  only  the  image 

•  Display  the  image  with  the  model  superimposed 

•  Input  a  new  position  and  display 


/•  FUNCTION:  CHANGEOVERLAY.C  */ 

I*  PURPOSE:  Displays  input  image  with  wire_frame  model  from  pose  */ 

f*  superimposed.  Mouse  buttons  function  as  follows:  *! 

I*  Left  mouse  —  Image  only  */ 

I*  Middle  mouse  -  Model  lines  over  image  */ 

/*  Right  mouse  --  Accepts  pose  and  displays  image  with  */ 

r  wire-frame  model  superimirosed.  */ 

/*  PARAMETERS:  Stored  rgb  image  as  <image  name>.pic  */ 

/•RETURNS:  none  •/ 

/•CALLED BY;  none  •/ 

f*  CALLS  TO:  make_world.  get_view,  read_sgi_rgbimage,  draw_white_  •/ 
/•  model  lines  •/ 

/•  GLOBALS:  CAMERA.HEIGHT,  FOCAL.LENGTH  (Both  are  constants)  •/ 
/•  COMMENTS:  Mark  DeClue,  24  Feb  93  •/ 


#include  <gl.h>  /*  SiliconGraphics  (r)  g^hic  library  •/ 

finclude  <gl/image.h>  /•  SGI  image  structure  library  •/ 

#include  <device.h>  /*  Machine-dependent  device  library  •/ 

#inc]ude  <stdio.h>  /•  C  standard  i/o  library  •/ 
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I*  C  math  library  fcv  ataii20 


#incliKle  <math.h> 
iinclude  “2d+.h” 
tinclude  “5th.h" 
#inclucle  “graphics.!)'' 
#include  “visibiltty.h” 


•/ 


iinclude  “image.types.h”  /•  Type  definitions  for  NPSIMAGE,  etc.  */ 

iinclude  “match_types.h’*  r  Type  definitions  for  EDGE,  1MG_LINE..  •/ 

iinclude  “npsimagesui^xirth’'  /*  Some  NPSIMAGE  functions  ~  */ 

iinclude  “edgesuppott.h”  /*  EDGE  and  IMG.U^  buildup  functions  */ 

iinclude  “vertsupporth"  /•  Vertical  EDGE  and  IMG_LINE  supplemem  */ 

iinclude  “matchsupporLh”  r  LINE  and  IMG.LINE  matching  routines  */ 

iinclude  “matchdi^laysupport.h“  /*  Graphics  display  functions  */ 

iinclude  “marksubs-h”  /*  VIEWPT  Hata  structure  •/ 


main(argc,  argv) 
int  argc; 
char  *argvU; 

< 

WORLD  ‘fifthfloon 

NPSIMAGE  ‘irng; 
LINE.HEAD  •m  =  NULL; 
VIEWPT  ‘getpos; 

shon  value; 

long  winid; 

int  keeponsl; 


foregroundO; 

/*  —Read  in  the  image  to  be  displayed—  */ 

img  *  read_sgi_rgbimage(argv(l)); 
printf(“Vn%s  has  been  stored^’*,  img->name); 


/*  —Set  up  5th  deck  database  model—  •/ 
flfthfloor  s  make.worldO; 

/*  — Initialize  for  display  and  control —  */ 

piefsize(img->xsize,  img->ysize);  /•  preferred  size  for  window  •/ 

winid  =  winopen(img->name);  /*  <^n  the  window  •/ 

RGBmodeO;  /*  set  RGBmode,  singlebuffer,  and  */ 

singlebufferO;  /*  configure  the  window  */ 

gconfigO; 

qdevice(REDRAW); 

qdevice(RIGHTMOUSE); 

qdevice(ESCKEY); 

qdevice(MIDDLEMOUSE); 

qdevice(LEFTMOUSE); 

getpos  =  (VIEWPT  *)  malloc(sizeof(VIEWPT)); 


r  — Initial  di^lay  of  image—  */ 


winset(winid); 

liectwrite(0. 0,  img->xsize  - 1,  img->ysize  - 1.  img->imgdata.bitsptr); 


/*  — Initial  pose  accq>tance  and  display—  */ 


printfC^nEnter  desired  initial  viewrXn”); 


fnush(stdoiit); 

printfrX:-); 

fflush(stdout); 

scanf(‘N)%ir,  &geq)os->X); 

{ffintfC>nY:  “); 
scanf(‘^n%ir,  &getpos->Y); 
printf(‘>nZ:  “): 
scanf(‘>n%ir,  &getpos->Z); 
primfC‘'«THCTA;  “); 
scanf(‘Ni%ir.  &geqx)s->THETA); 

m  ■  get  view(geipos->X.  getpos->Y,  geqx»->Z,  getpos->THETA.  fifthfloor, 
FOCAL.LENGTH); 

draw_white_inodeLlines(m->VLINE_LIST); 

<lraw_while_inodel_lines(m->LINE_LIST); 

f*  — List  available  options—  */ 

printfC'VnOptions  available  are  as  follows  ...Nn”); 

printf(“Vn  Left  mouse  button  ->  Display  image  onlyNn**); 

printfC*  Middle  mouse  bunon  •>  Superimpose  wire-frame  model  based  on  “); 

printfC'current  poseVt”); 

prmtfr  Right  mouse  ^aon  •>  Accepts  new  pose.  Displays  image  &  wire-"); 

printf^C'frame  modebn”): 

printfC*  ESC  key  ->  Exit  programNn"); 

/*  — Loop  until  a  mouse  button  is  pressed—  V 

while  (keeponsB  1) 

\ 

switch  (qread(&value)) 

I 

case  REDRAW; 
winset((1ong)  value); 
leshapeviewix^O; 
if  (value  ss  winid) 

lrectwrite(0. 0,  img->xsize  - 1,  img->ysizc  - 1,  img->imgdata.bitsptr); 

I 

break; 

caseRIGHTMOUSE: 
if  (value  —  0) 

I*  — Gel  pose  values  for  model  image—  •/ 

printf(‘^llEnter  desired  new  view:\i"); 

fflush(stdout); 

printf(“X:  “); 

fflushfstdout); 

scanfCNt^lT,  &getpos->X); 
printf(*‘'nY;  “); 
scanf(*Ni%ir,  &getpos->Y); 
printfCSnZ:  “); 
scanf(‘Ni%ir.  &getpos->Z); 
printf(•^nTHETA:  “); 

$canf(*Nt%ir,  &ge^K)s->THETA); 

m  s  get  view(getpos->X.  getpos->Y.  getpos->Z,  geipos->THETA.  fifthfloor, 
FOCAL_LENGTH); 


litctwrite(0, 0.  iing->xsize  - 1.  iina->ysize  •  1.  iing->iingdaia-biispe'): 

draw_white_ino(leLBnes(in->VLWE_LlST); 

draw_whiie_modeLiines(m'>LINE_LIST): 

prillt^'^llNew  wire-frame  image  has  been  superimposed^)''); 

) 

break; 

caseESCKEY: 

keepon«0; 

bre^; 

case  LEFTMOUSE: 
if  (value  0) 

lrectwriie(0. 0.  img->xsize  - 1.  img->ysize  - 1.  img->tmg(l^bitspir); 
break; 

caseMIDDLEMOUSE: 
if  (value  «  0) 

{ 

diaw_white_model_liiies(m->VLINE_LIST); 
draw  white  model  lines(m->LINE_OST); 

) 

break; 

default: 

break; 

\/*  end  switch  •/ 

)/•  end  while  •/ 

/•  “Clean  up  from  display  work—  */ 

free(img->imgdata.biisptr);  /*  delete  the  bitmap  for  the  image  */ 
free(img);  /•  delete  the  NPSIMAGE  structure  •/ 

winclos^winid);  /*  close  the  window  •/ 

printfCNftThanks  for  using  changeoverlay.  Have  a  nice  daylNn”); 

) 
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